|
| 1 | +/* ____________________________ |
| 2 | + This software is licensed under the MIT License: |
| 3 | + https://github.com/cifertech/nrfbox |
| 4 | + ________________________________________ */ |
| 5 | + |
| 6 | +#include <Arduino.h> |
| 7 | +#include "analyzer.h" |
| 8 | + |
| 9 | +extern U8G2_SSD1306_128X64_NONAME_F_HW_I2C u8g2; |
| 10 | + |
| 11 | +#define NRF24_CONFIG 0x00 |
| 12 | +#define NRF24_EN_AA 0x01 |
| 13 | +#define NRF24_RF_CH 0x05 |
| 14 | +#define NRF24_RF_SETUP 0x06 |
| 15 | +#define NRF24_RPD 0x09 |
| 16 | + |
| 17 | +#define SCREEN_WIDTH 128 |
| 18 | +#define SCREEN_HEIGHT 64 |
| 19 | + |
| 20 | +#define N 128 |
| 21 | +uint8_t values[N]; |
| 22 | + |
| 23 | +#define CE 5 |
| 24 | +#define CSN 17 |
| 25 | + |
| 26 | +#define CHANNELS 64 |
| 27 | +int CHannel[CHANNELS]; |
| 28 | + |
| 29 | + |
| 30 | +byte getregister(byte r) { |
| 31 | + byte c; |
| 32 | + |
| 33 | + digitalWrite(CSN, LOW); |
| 34 | + SPI.transfer(r & 0x1F); |
| 35 | + c = SPI.transfer(0); |
| 36 | + digitalWrite(CSN, HIGH); |
| 37 | + |
| 38 | + return c; |
| 39 | +} |
| 40 | + |
| 41 | +void setregister(byte r, byte v) { |
| 42 | + digitalWrite(CSN, LOW); |
| 43 | + SPI.transfer((r & 0x1F) | 0x20); |
| 44 | + SPI.transfer(v); |
| 45 | + digitalWrite(CSN, HIGH); |
| 46 | +} |
| 47 | + |
| 48 | +void powerup(void) { |
| 49 | + setregister(NRF24_CONFIG, getregister(NRF24_CONFIG) | 0x02); |
| 50 | + delayMicroseconds(130); |
| 51 | +} |
| 52 | + |
| 53 | +void powerdown(void) { |
| 54 | + setregister(NRF24_CONFIG, getregister(NRF24_CONFIG) & ~0x02); |
| 55 | +} |
| 56 | + |
| 57 | +void ENable(void) { |
| 58 | + digitalWrite(CE, HIGH); |
| 59 | +} |
| 60 | + |
| 61 | +void DIsable(void) { |
| 62 | + digitalWrite(CE, LOW); |
| 63 | +} |
| 64 | + |
| 65 | +void setrx(void) { |
| 66 | + setregister(NRF24_CONFIG, getregister(NRF24_CONFIG) | 0x01); |
| 67 | + ENable(); |
| 68 | + delayMicroseconds(100); |
| 69 | +} |
| 70 | + |
| 71 | +void ScanChannels(void) { |
| 72 | + DIsable(); |
| 73 | + // for (int j = 0; j < 10; j++) { |
| 74 | + for (int i = 0; i < CHANNELS; i++) { |
| 75 | + setregister(NRF24_RF_CH, (128 * i) / CHANNELS); |
| 76 | + setrx(); |
| 77 | + delayMicroseconds(40); |
| 78 | + DIsable(); |
| 79 | + if (getregister(NRF24_RPD) > 0) CHannel[i]++; |
| 80 | + } |
| 81 | + // } |
| 82 | +} |
| 83 | + |
| 84 | + |
| 85 | +void writeRegister(uint8_t reg, uint8_t value) { |
| 86 | + digitalWrite(CSN, LOW); |
| 87 | + SPI.transfer(reg | 0x20); |
| 88 | + SPI.transfer(value); |
| 89 | + digitalWrite(CSN, HIGH); |
| 90 | +} |
| 91 | + |
| 92 | +uint8_t readRegister(uint8_t reg) { |
| 93 | + digitalWrite(CSN, LOW); |
| 94 | + SPI.transfer(reg & 0x1F); |
| 95 | + uint8_t result = SPI.transfer(0x00); |
| 96 | + digitalWrite(CSN, HIGH); |
| 97 | + return result; |
| 98 | +} |
| 99 | + |
| 100 | +void setChannel(uint8_t CHannel) { |
| 101 | + writeRegister(NRF24_RF_CH, CHannel); |
| 102 | +} |
| 103 | + |
| 104 | +void powerUP() { |
| 105 | + uint8_t config = readRegister(NRF24_CONFIG); |
| 106 | + writeRegister(NRF24_CONFIG, config | 0x02); |
| 107 | + delay(5); |
| 108 | +} |
| 109 | + |
| 110 | +void powerDOWN() { |
| 111 | + uint8_t config = readRegister(NRF24_CONFIG); |
| 112 | + writeRegister(NRF24_CONFIG, config & ~0x02); |
| 113 | +} |
| 114 | + |
| 115 | +void startListening() { |
| 116 | + digitalWrite(CE, HIGH); |
| 117 | +} |
| 118 | + |
| 119 | +void stopListening() { |
| 120 | + digitalWrite(CE, LOW); |
| 121 | +} |
| 122 | + |
| 123 | +bool carrierDetected() { |
| 124 | + return readRegister(NRF24_RPD) & 0x01; |
| 125 | +} |
| 126 | + |
| 127 | + |
| 128 | +void analyzerSetup(){ |
| 129 | + |
| 130 | + Serial.begin(115200); |
| 131 | + |
| 132 | + esp_bt_controller_deinit(); |
| 133 | + esp_wifi_stop(); |
| 134 | + esp_wifi_deinit(); |
| 135 | + |
| 136 | + pinMode(CE, OUTPUT); |
| 137 | + pinMode(CSN, OUTPUT); |
| 138 | + |
| 139 | + SPI.begin(18, 19, 23, 17); |
| 140 | + SPI.setDataMode(SPI_MODE0); |
| 141 | + SPI.setFrequency(10000000); |
| 142 | + SPI.setBitOrder(MSBFIRST); |
| 143 | + |
| 144 | + u8g2.begin(); |
| 145 | + u8g2.clearBuffer(); |
| 146 | + u8g2.sendBuffer(); |
| 147 | + |
| 148 | + digitalWrite(CSN, HIGH); |
| 149 | + digitalWrite(CE, LOW); |
| 150 | + |
| 151 | + DIsable(); |
| 152 | + |
| 153 | + powerUP(); |
| 154 | + writeRegister(NRF24_EN_AA, 0x00); |
| 155 | + writeRegister(NRF24_RF_SETUP, 0x0F); |
| 156 | + |
| 157 | +} |
| 158 | + |
| 159 | +void analyzerLoop(){ |
| 160 | + |
| 161 | + ScanChannels(); |
| 162 | + |
| 163 | + memset(values, 0, sizeof(values)); |
| 164 | + |
| 165 | + int n = 50; |
| 166 | + while (n--) { |
| 167 | + int i = N; |
| 168 | + while (i--) { |
| 169 | + setChannel(i); |
| 170 | + startListening(); |
| 171 | + delayMicroseconds(128); |
| 172 | + stopListening(); |
| 173 | + if (carrierDetected()) { |
| 174 | + ++values[i]; |
| 175 | + } |
| 176 | + } |
| 177 | + } |
| 178 | + |
| 179 | + u8g2.clearBuffer(); |
| 180 | + int barWidth = SCREEN_WIDTH / N; |
| 181 | + int x = 0; |
| 182 | + for (int i = 0; i < N; ++i) { |
| 183 | + int v = 63 - values[i] * 3; |
| 184 | + if (v < 0) { |
| 185 | + v = 0; |
| 186 | + } |
| 187 | + u8g2.drawVLine(x, v - 10, 64 - v); |
| 188 | + x += barWidth; |
| 189 | + } |
| 190 | + |
| 191 | + u8g2.setFont(u8g2_font_ncenB08_tr); |
| 192 | + u8g2.setCursor(0, 64); |
| 193 | + u8g2.print("1...5...10...25..50...80...128"); |
| 194 | + u8g2.sendBuffer(); |
| 195 | + |
| 196 | + delay(50); |
| 197 | + |
| 198 | +} |
0 commit comments