nrf24scan.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560
  1. //
  2. // Written by vad7, 20.11.2022.
  3. // ver. 1.0
  4. //
  5. #include "nrf24scan.h"
  6. #include <furi.h>
  7. #include <furi_hal.h>
  8. #include <gui/gui.h>
  9. #include <dialogs/dialogs.h>
  10. #include <input/input.h>
  11. #include <notification/notification_messages.h>
  12. #include <stdlib.h>
  13. #include <dolphin/dolphin.h>
  14. #include <nrf24.h>
  15. #define TAG "nrf24scan"
  16. #define MAX_CHANNEL 125
  17. #define MAX_ADDR 6
  18. #define SCAN_APP_PATH_FOLDER "/ext/nrf24scan"
  19. #define ADDR_FILENAME "addr.txt" // File format (1 parameter per line):
  20. // 0.25/1/2 - rate in Mbps
  21. // 0..125 - default channel
  22. // address P0 in hex (5 byte, LSB last)
  23. // address P1 in hex (5 byte, LSB last)
  24. // address P2, LSB in hex (1 byte)
  25. // address P3, LSB in hex (1 byte)
  26. // address P4, LSB in hex (1 byte)
  27. // address P5, LSB in hex (1 byte)
  28. // captured data in raw format, first byte = addr # 0..5
  29. // ... up to MAX_LOG_RECORDS
  30. #define LOG_FILENAME "log.txt"
  31. #define MAX_LOG_RECORDS 99
  32. #define LOG_REC_SIZE 33 // max packet size
  33. #define VIEW_LOG_MAX_X 21
  34. Nrf24Scan* nrf24scan;
  35. uint8_t what_doing = 0; // 0 - setup, 1 - scanning
  36. char screen_buf[64];
  37. char addr_file_name[32];
  38. uint8_t NRF_rate; // 0 - 250Kbps, 1 - 1Mbps, 2 - 2Mbps
  39. uint8_t NRF_channel; // 0..125
  40. struct {
  41. uint8_t addr_P0[5]; // MSB first
  42. uint8_t addr_P1[5]; // MSB first
  43. uint8_t addr_P2; // LSB only, MSB bytes equal addr_P1
  44. uint8_t addr_P3; // LSB only, MSB bytes equal addr_P1
  45. uint8_t addr_P4; // LSB only, MSB bytes equal addr_P1
  46. uint8_t addr_P5; // LSB only, MSB bytes equal addr_P1
  47. uint8_t addr_len; // 2..5
  48. uint8_t addr_count;
  49. } addrs;
  50. int8_t log_to_file = 0; // 0 - no, 1 - yes, 2 - new, -1 - only clear
  51. uint16_t log_arr_idx;
  52. uint16_t view_log_arr_idx = 0;
  53. uint16_t view_log_arr_x = 0;
  54. uint16_t last_packet_send = -1;
  55. uint8_t last_packet_send_st = 0;
  56. int16_t find_channel_period = 0; // sec
  57. uint8_t menu_selected = 0;
  58. #define menu_selected_max 5
  59. uint32_t start_time;
  60. static uint8_t GetHexVal(char hex) {
  61. return (uint8_t)hex - ((uint8_t)hex < 58 ? 48 : ((uint8_t)hex < 97 ? 55 : 87));
  62. }
  63. // Return num bytes in array
  64. static uint8_t ConvertHexToArray(char * hex, uint8_t * array, uint8_t maxlen) {
  65. uint8_t len = 0;
  66. do {
  67. uint8_t ch = *hex++;
  68. if(ch == 0) break;
  69. if(ch < '0') continue;
  70. *array++ = (GetHexVal(ch) << 4) + GetHexVal(*hex++);
  71. len++;
  72. } while(--maxlen);
  73. return len;
  74. }
  75. static void add_to_str_hex_bytes(char *out, char *arr, int bytes)
  76. {
  77. if(!bytes) return;
  78. out += strlen(out);
  79. do {
  80. snprintf(out, 3, "%02X", *arr++);
  81. out += 2;
  82. } while(--bytes);
  83. }
  84. void clear_log()
  85. {
  86. log_arr_idx = 0;
  87. view_log_arr_idx = 0;
  88. last_packet_send = -1;
  89. }
  90. void write_to_log_file(Storage* storage)
  91. {
  92. if(log_arr_idx == 0) return;
  93. Stream* file_stream = file_stream_alloc(storage);
  94. FuriString* path = furi_string_alloc();
  95. furi_string_set(path, SCAN_APP_PATH_FOLDER);
  96. furi_string_cat(path, "/");
  97. furi_string_cat(path, LOG_FILENAME);
  98. char *txt = malloc(LOG_REC_SIZE * 2 + 2);
  99. if(txt == NULL) {
  100. FURI_LOG_E(TAG, "No memory to save log!");
  101. } else {
  102. if(file_stream_open(file_stream, furi_string_get_cstr(path), FSAM_READ_WRITE, FSOM_OPEN_APPEND)) {
  103. for(int i = 0; i < log_arr_idx; i++) {
  104. add_to_str_hex_bytes(txt, (char*)nrf24scan->log_arr + i * LOG_REC_SIZE, LOG_REC_SIZE);
  105. strcat(txt, "\n");
  106. int len = strlen(txt);
  107. if(stream_write(file_stream, (uint8_t*)txt, len) != len) {
  108. FURI_LOG_I(TAG, "Failed to write bytes to log!");
  109. break;
  110. }
  111. }
  112. } else {
  113. FURI_LOG_E(TAG, "Failed to open log file");
  114. }
  115. free(txt);
  116. }
  117. file_stream_close(file_stream);
  118. furi_string_free(path);
  119. stream_free(file_stream);
  120. }
  121. static void render_callback(Canvas* const canvas, void* ctx) {
  122. const PluginState* plugin_state = acquire_mutex((ValueMutex*)ctx, 25);
  123. if(plugin_state == NULL) return;
  124. //canvas_draw_frame(canvas, 0, 0, 128, 64); // border around the edge of the screen
  125. if(what_doing == 0) {
  126. canvas_set_font(canvas, FontSecondary); // 8x10 font
  127. snprintf(screen_buf, sizeof(screen_buf), "Settings: %s", addr_file_name); // menu_selected = 0
  128. canvas_draw_str(canvas, 10, 10, screen_buf);
  129. snprintf(screen_buf, sizeof(screen_buf), "Channel: %d", NRF_channel); // menu_selected = 1
  130. canvas_draw_str(canvas, 10, 20, screen_buf);
  131. snprintf(screen_buf, sizeof(screen_buf), "Rate: %sbps", NRF_rate == 2 ? "2M" : NRF_rate == 1 ? "1M" : "250K"); // menu_selected = 2
  132. canvas_draw_str(canvas, 10, 30, screen_buf);
  133. strcpy(screen_buf, "Find channel period: "); // menu_selected = 3
  134. if(find_channel_period == 0) strcat(screen_buf, "off"); else snprintf(screen_buf + strlen(screen_buf), sizeof(screen_buf), "%d s", find_channel_period);
  135. canvas_draw_str(canvas, 10, 40, screen_buf);
  136. snprintf(screen_buf, sizeof(screen_buf), "Log: %s", log_to_file == 0 ? "No" : log_to_file == 1 ? "Yes" : log_to_file == 2 ? "New" : "Clear");// menu_selected = 4
  137. canvas_draw_str(canvas, 10, 50, screen_buf);
  138. snprintf(screen_buf, sizeof(screen_buf), "Ok - Start read (%dp)", addrs.addr_count); // menu_selected = 5
  139. canvas_draw_str(canvas, 10, 60, screen_buf);
  140. canvas_draw_str(canvas, 0, menu_selected * 10 + 10, ">");
  141. } else {
  142. canvas_set_font(canvas, FontBatteryPercent); // 5x7 font, 9 lines
  143. char ch2 = ' ';
  144. screen_buf[0] = '\0';
  145. if(view_log_arr_x == 0) { strcat(screen_buf, " "); ch2 = '>';
  146. } else {
  147. snprintf(screen_buf, sizeof(screen_buf), "<%d", view_log_arr_x);
  148. if(view_log_arr_x < VIEW_LOG_MAX_X) ch2 = '>';
  149. }
  150. snprintf(screen_buf + strlen(screen_buf), sizeof(screen_buf), " Read %d channel... %c", NRF_channel, ch2);
  151. canvas_draw_str(canvas, 0, 7, screen_buf);
  152. if(log_arr_idx) {
  153. uint16_t page = view_log_arr_idx & ~7;
  154. for(uint8_t i = 0; i < 8 && page + i < log_arr_idx; i++) {
  155. snprintf(screen_buf, sizeof(screen_buf), "%d: ", page + i + 1);
  156. canvas_draw_str(canvas, 0, 14 + i * 7, screen_buf);
  157. char *ptr = (char*)nrf24scan->log_arr + (page + i) * LOG_REC_SIZE + view_log_arr_x;
  158. if(view_log_arr_x == 0) {
  159. snprintf(screen_buf, sizeof(screen_buf), "%d-", *ptr + 1);
  160. add_to_str_hex_bytes(screen_buf, ptr + 1, 10);
  161. } else {
  162. screen_buf[0] = '\0';
  163. add_to_str_hex_bytes(screen_buf, ptr + 1, 11);
  164. }
  165. canvas_draw_str(canvas, 13, 14 + i * 7, screen_buf);
  166. }
  167. canvas_draw_str(canvas, 10, 14 + (view_log_arr_idx & 7) * 7, last_packet_send != view_log_arr_idx ? ">" : last_packet_send_st == 0 ? "!" : "+");
  168. }
  169. }
  170. release_mutex((ValueMutex*)ctx, plugin_state);
  171. }
  172. static bool select_settings_file(Stream* stream) {
  173. DialogsApp* dialogs = furi_record_open("dialogs");
  174. bool result = false;
  175. FuriString* path;
  176. path = furi_string_alloc();
  177. furi_string_set(path, SCAN_APP_PATH_FOLDER);
  178. DialogsFileBrowserOptions browser_options;
  179. dialog_file_browser_set_basic_options(&browser_options, ".txt", NULL);
  180. browser_options.hide_ext = false;
  181. bool ret = dialog_file_browser_show(dialogs, path, path, &browser_options);
  182. furi_record_close("dialogs");
  183. if(ret) {
  184. if(!file_stream_open(stream, furi_string_get_cstr(path), FSAM_READ, FSOM_OPEN_EXISTING)) {
  185. file_stream_close(stream);
  186. FURI_LOG_D(TAG, "Cannot open file \"%s\"", furi_string_get_cstr(path));
  187. } else {
  188. FURI_LOG_D(TAG, "Open file \"%s\"", furi_string_get_cstr(path));
  189. strncpy(addr_file_name, furi_string_get_cstr(path) + sizeof(SCAN_APP_PATH_FOLDER), sizeof(addr_file_name));
  190. result = true;
  191. }
  192. }
  193. furi_string_free(path);
  194. return result;
  195. }
  196. static bool load_settings_file(Stream* file_stream) {
  197. size_t file_size = 0;
  198. char* file_buf;
  199. bool loaded = false;
  200. file_size = stream_size(file_stream);
  201. if(file_size == (size_t)0) {
  202. FURI_LOG_D(TAG, "load failed. file_size: %d", file_size);
  203. return loaded;
  204. }
  205. file_buf = malloc(file_size);
  206. memset(file_buf, 0, file_size);
  207. if(stream_read(file_stream, (uint8_t*)file_buf, file_size) == file_size) {
  208. FURI_LOG_D(TAG, "Loading settings file");
  209. char* line_ptr = file_buf;
  210. int16_t line_num = 0;
  211. memset((uint8_t*)&addrs, 0, sizeof(addrs));
  212. while(line_ptr && line_ptr - file_buf < file_size) {
  213. char* end_ptr = strstr((char*)line_ptr, "\n");
  214. if(end_ptr == NULL) end_ptr = file_buf + file_size; else *end_ptr = '\0';
  215. FURI_LOG_D(TAG, " L#%d: [%d]%s", line_num, end_ptr - line_ptr, line_ptr);
  216. if(*line_ptr == '\r') {
  217. line_ptr = end_ptr + 1;
  218. continue;
  219. }
  220. if(end_ptr - line_ptr >= LOG_REC_SIZE * 2) { // data
  221. if(log_arr_idx < MAX_LOG_RECORDS) {
  222. ConvertHexToArray(line_ptr, nrf24scan->log_arr + log_arr_idx * LOG_REC_SIZE, LOG_REC_SIZE);
  223. log_arr_idx++;
  224. clear_log();
  225. }
  226. } else if(addrs.addr_count) {
  227. ConvertHexToArray(line_ptr, addrs.addr_count==1? &addrs.addr_P1[0] : addrs.addr_count==2? &addrs.addr_P2 : addrs.addr_count==3? &addrs.addr_P3 : addrs.addr_count==4? &addrs.addr_P4: &addrs.addr_P5, addrs.addr_count==1? 5 : 1);
  228. FURI_LOG_D(TAG, " +Addr_LSB: %s", line_ptr);
  229. if(++addrs.addr_count == MAX_ADDR) break;
  230. } else if(end_ptr - line_ptr < 4) { // Rate or Channel
  231. if(line_num == 0) { // 1st line - Rate
  232. NRF_rate = atoi(line_ptr);
  233. FURI_LOG_D(TAG, " Rate: %d", NRF_rate);
  234. } else if(line_num == 1) { // second line - Channel
  235. NRF_channel = atoi(line_ptr);
  236. FURI_LOG_D(TAG, " Ch: %d", NRF_channel);
  237. }
  238. } else if(end_ptr - line_ptr <= 5*2 + 1){ // addresses
  239. addrs.addr_len = ConvertHexToArray(line_ptr, addrs.addr_P0, 5);
  240. FURI_LOG_D(TAG, " +Addr(%d): %02X%02X%02X...", addrs.addr_len, addrs.addr_P0[0], addrs.addr_P0[1], addrs.addr_P0[2]);
  241. loaded = true;
  242. if(++addrs.addr_count == MAX_ADDR) break;
  243. }
  244. line_ptr = end_ptr + 1;
  245. line_num++;
  246. }
  247. } else {
  248. FURI_LOG_D(TAG, "load failed. file size: %d", file_size);
  249. }
  250. free(file_buf);
  251. return loaded;
  252. }
  253. static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) {
  254. furi_assert(event_queue);
  255. PluginEvent event = {.type = EventTypeKey, .input = *input_event};
  256. furi_message_queue_put(event_queue, &event, FuriWaitForever);
  257. }
  258. static void start_scanning()
  259. {
  260. uint8_t addr[5];
  261. uint8_t erx_addr = (1<<0); // Enable RX_P0
  262. if(addrs.addr_count == 0) return;
  263. nrf24_write_reg(nrf24_HANDLE, REG_CONFIG, 0x00); // Stop nRF
  264. nrf24_write_reg(nrf24_HANDLE, REG_STATUS, 0x70); // clear interrupts
  265. nrf24_write_reg(nrf24_HANDLE, REG_DYNPD, 0x0); // disable shockburst
  266. nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0x00); // Disable Shockburst
  267. nrf24_write_reg(nrf24_HANDLE, REG_FEATURE, 0x01); // Enables the W_TX_PAYLOAD_NOACK command, Disable Payload with ACK, Disable Dynamic Payload Length
  268. nrf24_set_maclen(nrf24_HANDLE, addrs.addr_len);
  269. for(int i = 0; i < addrs.addr_len; i++) addr[i] = addrs.addr_P0[addrs.addr_len - i - 1];
  270. nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P0, &addr[0], addrs.addr_len);
  271. nrf24_write_reg(nrf24_HANDLE, RX_PW_P0, 32);
  272. if(addrs.addr_count > 1) {
  273. for(int i = 0; i < addrs.addr_len; i++) addr[i] = addrs.addr_P1[addrs.addr_len - i - 1];
  274. nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P1, &addr[0], addrs.addr_len);
  275. nrf24_write_reg(nrf24_HANDLE, RX_PW_P1, 32);
  276. erx_addr |= (1<<1); // Enable RX_P1
  277. } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P1, 0);
  278. if(addrs.addr_count > 2) {
  279. nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P2, &addrs.addr_P2, 1);
  280. nrf24_write_reg(nrf24_HANDLE, RX_PW_P2, 32);
  281. erx_addr |= (1<<2); // Enable RX_P2
  282. } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P2, 0);
  283. if(addrs.addr_count > 3) {
  284. nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P3, &addrs.addr_P3, 1);
  285. nrf24_write_reg(nrf24_HANDLE, RX_PW_P3, 32);
  286. erx_addr |= (1<<3); // Enable RX_P3
  287. } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P3, 0);
  288. if(addrs.addr_count > 4) {
  289. nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P4, &addrs.addr_P4, 1);
  290. nrf24_write_reg(nrf24_HANDLE, RX_PW_P4, 32);
  291. erx_addr |= (1<<4); // Enable RX_P4
  292. } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P4, 0);
  293. if(addrs.addr_count > 5) {
  294. nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P5, &addrs.addr_P5, 1);
  295. nrf24_write_reg(nrf24_HANDLE, RX_PW_P5, 32);
  296. erx_addr |= (1<<5); // Enable RX_P5
  297. } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P5, 0);
  298. nrf24_write_reg(nrf24_HANDLE, REG_STATUS, 0x50); // clear RX_DR, MAX_RT.
  299. nrf24_set_idle(nrf24_HANDLE);
  300. nrf24_flush_rx(nrf24_HANDLE);
  301. nrf24_flush_tx(nrf24_HANDLE);
  302. nrf24_write_reg(nrf24_HANDLE, REG_EN_RXADDR, erx_addr);
  303. nrf24_write_reg(nrf24_HANDLE, REG_RF_CH, NRF_channel);
  304. nrf24_write_reg(nrf24_HANDLE, REG_RF_SETUP, NRF_rate);
  305. // prime for RX, no checksum
  306. nrf24_write_reg(nrf24_HANDLE, REG_CONFIG, 0x03); // PWR_UP and PRIM_RX, disable AA and CRC
  307. furi_hal_gpio_write(nrf24_CE_PIN, true);
  308. furi_delay_ms(100);
  309. start_time = furi_get_tick();
  310. FURI_LOG_D(TAG, "Start scan: Ch=%d Rate=%d", NRF_channel, NRF_rate);
  311. }
  312. bool nrf24_read_newpacket() {
  313. if(nrf24scan->log_arr == NULL) return false;
  314. bool found = false;
  315. uint8_t packetsize;
  316. uint8_t packet[32] = {0};
  317. uint8_t status = nrf24_rxpacket(nrf24_HANDLE, packet, &packetsize, true);
  318. if(status & 0x40) {
  319. uint8_t *ptr = nrf24scan->log_arr + log_arr_idx * LOG_REC_SIZE;
  320. *ptr++ = (status >> 1) & 7; // pipe #
  321. memcpy(ptr, packet, packetsize);
  322. if(packetsize < LOG_REC_SIZE) memset(ptr + packetsize, 0, LOG_REC_SIZE - packetsize);
  323. if(log_arr_idx < MAX_LOG_RECORDS - 1) {
  324. log_arr_idx++;
  325. } else {
  326. if(log_to_file > 0) {
  327. write_to_log_file(nrf24scan->storage);
  328. log_arr_idx = 0;
  329. } else {
  330. memmove(nrf24scan->log_arr, nrf24scan->log_arr + LOG_REC_SIZE, log_arr_idx * LOG_REC_SIZE);
  331. }
  332. }
  333. FURI_LOG_D(TAG, "Found packet #%d pipe %d", log_arr_idx, (status >> 1) & 7);
  334. found = true;
  335. }
  336. return found;
  337. }
  338. bool nrf24_send_packet()
  339. {
  340. if(log_arr_idx == 0) return false;
  341. last_packet_send_st = nrf24_txpacket(nrf24_HANDLE, nrf24scan->log_arr + view_log_arr_idx * LOG_REC_SIZE + 1, 32, false);
  342. last_packet_send = view_log_arr_idx;
  343. return last_packet_send_st;
  344. }
  345. void allocate_log_array()
  346. {
  347. nrf24scan->log_arr = malloc(LOG_REC_SIZE * MAX_LOG_RECORDS);
  348. if(nrf24scan->log_arr == NULL) {
  349. FURI_LOG_E(TAG, "Not enouch memory: %d", LOG_REC_SIZE * MAX_LOG_RECORDS);
  350. strcpy(addr_file_name, "MEMORY LOW!");
  351. }
  352. clear_log();
  353. }
  354. int32_t nrf24scan_app(void* p) {
  355. UNUSED(p);
  356. nrf24scan = malloc(sizeof(Nrf24Scan));
  357. nrf24scan->event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent));
  358. nrf24scan->plugin_state = malloc(sizeof(PluginState));
  359. ValueMutex state_mutex;
  360. if(!init_mutex(&state_mutex, nrf24scan->plugin_state, sizeof(PluginState))) {
  361. furi_message_queue_free(nrf24scan->event_queue);
  362. FURI_LOG_E(TAG, "cannot create mutex\r\n");
  363. free(nrf24scan->plugin_state);
  364. return 255;
  365. }
  366. memset((uint8_t*)&addrs, 0, sizeof(addrs));
  367. nrf24_init();
  368. // Set system callbacks
  369. nrf24scan->view_port = view_port_alloc();
  370. view_port_draw_callback_set(nrf24scan->view_port, render_callback, &state_mutex);
  371. view_port_input_callback_set(nrf24scan->view_port, input_callback, nrf24scan->event_queue);
  372. // Open GUI and register view_port
  373. nrf24scan->gui = furi_record_open(RECORD_GUI);
  374. gui_add_view_port(nrf24scan->gui, nrf24scan->view_port, GuiLayerFullscreen);
  375. NotificationApp* notification = furi_record_open(RECORD_NOTIFICATION);
  376. nrf24scan->storage = furi_record_open(RECORD_STORAGE);
  377. storage_common_mkdir(nrf24scan->storage, SCAN_APP_PATH_FOLDER);
  378. Stream* file_stream = file_stream_alloc(nrf24scan->storage);
  379. FuriString* path = furi_string_alloc();
  380. furi_string_set(path, SCAN_APP_PATH_FOLDER);
  381. furi_string_cat(path, "/");
  382. furi_string_cat(path, ADDR_FILENAME);
  383. if(file_stream_open(file_stream, furi_string_get_cstr(path), FSAM_READ, FSOM_OPEN_EXISTING)) {
  384. if(load_settings_file(file_stream)) strcpy(addr_file_name, ADDR_FILENAME); else strcpy(addr_file_name, "LOAD ERROR");
  385. } else {
  386. strcpy(addr_file_name, "NONE");
  387. }
  388. file_stream_close(file_stream);
  389. furi_string_free(path);
  390. stream_free(file_stream);
  391. allocate_log_array();
  392. PluginEvent event;
  393. for(bool processing = true; processing;) {
  394. FuriStatus event_status = furi_message_queue_get(nrf24scan->event_queue, &event, 100);
  395. PluginState* plugin_state = (PluginState*)acquire_mutex_block(&state_mutex);
  396. if(event_status == FuriStatusOk) {
  397. // press events
  398. if(event.type == EventTypeKey) {
  399. switch(event.input.key) {
  400. case InputKeyUp:
  401. if(event.input.type == InputTypePress || event.input.type == InputTypeRepeat) {
  402. if(what_doing == 0) {
  403. if(menu_selected > 0) menu_selected--; else menu_selected = menu_selected_max;
  404. } else {
  405. if(view_log_arr_idx > 0) view_log_arr_idx--;
  406. }
  407. }
  408. break;
  409. case InputKeyDown:
  410. if(event.input.type == InputTypePress || event.input.type == InputTypeRepeat) {
  411. if(what_doing == 0) {
  412. if(menu_selected < menu_selected_max) menu_selected++; else menu_selected = 0;
  413. } else {
  414. if(view_log_arr_idx < log_arr_idx - 1) view_log_arr_idx++;
  415. }
  416. }
  417. break;
  418. case InputKeyRight:
  419. if(event.input.type == InputTypePress || event.input.type == InputTypeRepeat) {
  420. if(what_doing == 0) {
  421. switch(menu_selected) {
  422. case 1:
  423. NRF_channel += event.input.type == InputTypeRepeat ? 10 : 1;
  424. if(NRF_channel > MAX_CHANNEL) NRF_channel = 0;
  425. break;
  426. case 2:
  427. NRF_rate++;
  428. if(NRF_rate > 2) NRF_rate = 0;
  429. break;
  430. case 3:
  431. find_channel_period += event.input.type == InputTypeRepeat ? 10 : 1;
  432. break;
  433. case 4:
  434. if(++log_to_file > 2) log_to_file = -1;
  435. break;
  436. }
  437. } else {
  438. if(view_log_arr_x < VIEW_LOG_MAX_X) view_log_arr_x++;
  439. }
  440. }
  441. break;
  442. case InputKeyLeft:
  443. if(event.input.type == InputTypePress || event.input.type == InputTypeRepeat) {
  444. if(what_doing == 0) {
  445. switch(menu_selected) {
  446. case 1:
  447. NRF_channel -= event.input.type == InputTypeRepeat ? 10 : 1;
  448. if(NRF_channel > MAX_CHANNEL) NRF_channel = MAX_CHANNEL;
  449. break;
  450. case 2:
  451. NRF_rate--;
  452. if(NRF_rate > 2) NRF_rate = 2;
  453. break;
  454. case 3:
  455. find_channel_period -= event.input.type == InputTypeRepeat ? 10 : 1;
  456. if(find_channel_period < 0) find_channel_period = 0;
  457. break;
  458. case 4:
  459. if(--log_to_file < -1) log_to_file = 2;
  460. break;
  461. }
  462. } else {
  463. if(view_log_arr_x > 0) view_log_arr_x--;
  464. }
  465. }
  466. break;
  467. case InputKeyOk:
  468. if(event.input.type == InputTypePress) {
  469. if(what_doing == 0) {
  470. if(menu_selected == 0) { // File
  471. file_stream = file_stream_alloc(nrf24scan->storage);
  472. if(select_settings_file(file_stream)) {
  473. if(!load_settings_file(file_stream)) {
  474. strcpy(addr_file_name, "LOAD ERROR");
  475. } else {
  476. if(log_to_file > 0) write_to_log_file(nrf24scan->storage);
  477. clear_log();
  478. }
  479. file_stream_close(file_stream);
  480. }
  481. stream_free(file_stream);
  482. } else if(menu_selected == 5) {
  483. what_doing = !what_doing;
  484. if(what_doing) {
  485. if(log_to_file == 2 || log_to_file == -1) clear_log();
  486. start_scanning();
  487. } else nrf24_set_idle(nrf24_HANDLE);
  488. }
  489. } else { // Send
  490. nrf24_send_packet();
  491. }
  492. } else if(event.input.type == InputTypeLong) {
  493. what_doing = !what_doing;
  494. if(what_doing) {
  495. if(log_to_file == 2 || log_to_file == -1) clear_log();
  496. start_scanning();
  497. } else nrf24_set_idle(nrf24_HANDLE);
  498. }
  499. break;
  500. case InputKeyBack:
  501. if(event.input.type == InputTypeLong) processing = false; else what_doing = 0;
  502. nrf24_set_idle(nrf24_HANDLE);
  503. break;
  504. default:
  505. break;
  506. }
  507. }
  508. }
  509. if(what_doing) {
  510. nrf24_read_newpacket();
  511. if(find_channel_period && furi_get_tick() - start_time >= (uint32_t)find_channel_period * 1000UL) {
  512. if(++NRF_channel > MAX_CHANNEL) NRF_channel = 0;
  513. start_scanning();
  514. }
  515. }
  516. view_port_update(nrf24scan->view_port);
  517. release_mutex(&state_mutex, plugin_state);
  518. }
  519. nrf24_deinit();
  520. view_port_enabled_set(nrf24scan->view_port, false);
  521. gui_remove_view_port(nrf24scan->gui, nrf24scan->view_port);
  522. furi_record_close(RECORD_GUI);
  523. furi_record_close(RECORD_NOTIFICATION);
  524. furi_record_close(RECORD_STORAGE);
  525. view_port_free(nrf24scan->view_port);
  526. furi_message_queue_free(nrf24scan->event_queue);
  527. free(nrf24scan->plugin_state);
  528. if(nrf24scan->log_arr) free(nrf24scan->log_arr);
  529. free(nrf24scan);
  530. return 0;
  531. }