// // Written by vad7, 20.11.2022. // #include "nrf24scan.h" #include #include #include #include #include #include #include #include #include #define TAG "nrf24scan" #define VERSION "1.8" #define MAX_CHANNEL 125 #define MAX_ADDR 6 #define SCAN_APP_PATH_FOLDER "/ext/nrf24scan" #define SETTINGS_FILENAME "addresses.txt"// Settings file format (1 parameter per line): // SNIFF - if present then sniff mode // Rate: 0/1/2 - rate in Mbps (=0.25/1/2) // Ch: 0..125 - default channel // ESB: 0/1 (1 - Enhanced ShockBurst) // DPL: 0/1 (1 - Dynamic Payload Length) // CRC: 0/1/2 (CRC length) // Payload: 1..32 (bytes) // P0: address P0 in hex (5 byte, LSB last) // P1: address P1 in hex (5 byte, LSB last) // P2: address P2, LSB in hex (1 byte) // P3: address P3, LSB in hex (1 byte) // P4: address P4, LSB in hex (1 byte) // P5: address P5, LSB in hex (1 byte) // captured data: // first byte = { RAW packet flag (0x80/0x00) } + { channel number } // second byte = { Payload len 5 bits, 0 = 32 } + {{ RAW packet: ESB flag 0x04/0x00 + address size-2 if RAW packet } or { pipe #(0..5) }}, // ... up to MAX_LOG_RECORDS-1 #define SNIFF_FILENAME "sniff.txt" // settings for sniff mode #define LOG_FILENAME "log" #define LOG_FILEEXT ".txt" #define MAX_LOG_RECORDS 100 #define LOG_REC_SIZE 34 // max packet size #define VIEW_LOG_MAX_X 22 #define VIEW_LOG_WIDTH_B 10 // bytes const char SettingsFld_Rate[] = "Rate:"; const char SettingsFld_Ch[] = "Ch:"; const char SettingsFld_ESB[] = "ESB:"; const char SettingsFld_DPL[] = "DPL:"; const char SettingsFld_CRC[] = "CRC:"; const char SettingsFld_Payload[] = "Payload:"; const char SettingsFld_Sniff[] = "SNIFF"; char SettingsFld_Addr = 'P'; Nrf24Scan* APP; uint8_t what_doing = 0; // 0 - setup, 1 - view log, 2 - view addresses uint8_t what_to_do = 1; // 0 - view, 1 - view & sniff, 2 - view & read uint32_t key_press_seq_ok = 0; uint8_t save_settings = 0; char screen_buf[64]; char addr_file_name[32]; uint8_t NRF_rate = 1; // 0 - 250Kbps, 1 - 1Mbps, 2 - 2Mbps uint8_t NRF_channel = 0;// 0..125 uint8_t NRF_ESB = 1; // 0 - ShockBurst, 1 - Enhanced ShockBurst uint8_t NRF_DPL = 0; // 1 - Dynamic Payload Length uint8_t NRF_CRC = 2; // 1 - No, 1 - CRC 1byte, 2 - CRC 2byte uint8_t NRF_Payload = 32;// len in bytes, max 32 uint8_t NRF_Sniff_payload_max = 28; uint8_t NRF_AA_OFF = 0; // Disable Auto Acknowledgement bool NRF_ERROR = 0; struct { uint8_t addr_P0[5]; // MSB first uint8_t addr_P1[5]; // MSB first uint8_t addr_P2; // LSB only, MSB bytes equal addr_P1 uint8_t addr_P3; // LSB only, MSB bytes equal addr_P1 uint8_t addr_P4; // LSB only, MSB bytes equal addr_P1 uint8_t addr_P5; // LSB only, MSB bytes equal addr_P1 uint8_t addr_len; // 2..5 uint8_t addr_count; } addrs; int8_t log_to_file = 0; // 0 - no, 1 - yes(new), 2 - append, -1 - only clear uint16_t log_arr_idx; uint16_t view_log_arr_idx = 0; uint16_t view_log_arr_x = 0; bool save_to_new_log = true; uint16_t last_packet_send = -1; uint8_t last_packet_send_st = 0; int16_t find_channel_period = 0; // sec uint8_t menu_selected = 0; uint32_t start_time; uint8_t view_log_decode_PCF = 0; // view log: 1 - decode packet control field (9b) when ESB off. After pipe # (hex): uint8_t view_log_decode_CRC = 0; // CRC bytes - 1/2, 0 - none #define menu_selected_max 5 enum { Menu_open_file = 0, Menu_enter_channel, Menu_enter_rate, Menu_enter_scan_period, Menu_log, Menu_ok }; //#define MIN(a, b) ((a> 7)); arr++; out += 2; } while(--bytes); } void clear_log() { log_arr_idx = 0; view_log_arr_idx = 0; last_packet_send = -1; } void allocate_log_array() { APP->log_arr = malloc(LOG_REC_SIZE * MAX_LOG_RECORDS); if(APP->log_arr == NULL) { FURI_LOG_E(TAG, "Not enouch memory: %d", LOG_REC_SIZE * MAX_LOG_RECORDS); strcpy(addr_file_name, "MEMORY LOW!"); } clear_log(); } void write_to_log_file(Storage* storage, bool f_settings) { if(log_arr_idx == 0 && !f_settings) return; Stream* file_stream = file_stream_alloc(storage); FuriString* str = furi_string_alloc(); furi_string_set(str, SCAN_APP_PATH_FOLDER); furi_string_cat(str, "/"); bool fl; if(f_settings) { furi_string_cat(str, SETTINGS_FILENAME); fl = file_stream_open(file_stream, furi_string_get_cstr(str), FSAM_READ_WRITE, FSOM_CREATE_ALWAYS); if(!fl) file_stream_close(file_stream); } else { furi_string_cat(str, LOG_FILENAME); furi_string_cat(str, LOG_FILEEXT); if(save_to_new_log) { int cnt = 1; do { fl = file_stream_open(file_stream, furi_string_get_cstr(str), FSAM_READ_WRITE, FSOM_CREATE_NEW); if(fl) break; file_stream_close(file_stream); furi_string_set(str, SCAN_APP_PATH_FOLDER); furi_string_cat(str, "/"); furi_string_cat(str, LOG_FILENAME); furi_string_cat_printf(str, "-%02d", cnt); furi_string_cat(str, LOG_FILEEXT); } while(++cnt < 100); if(!fl) { FURI_LOG_E(TAG, "Failed to create new log file"); notification_message(APP->notification, &sequence_blink_red_100); } } else { fl = file_stream_open(file_stream, furi_string_get_cstr(str), FSAM_READ_WRITE, FSOM_OPEN_APPEND); if(fl) { if(stream_size(file_stream) == 0) save_to_new_log = true; } else file_stream_close(file_stream); } } if(fl) { FURI_LOG_D(TAG, "Save to %s", furi_string_get_cstr(str)); if(save_to_new_log || f_settings) { if(what_to_do == 1) furi_string_printf(str, "%s\n", SettingsFld_Sniff); else furi_string_reset(str); furi_string_cat_printf(str, "%s %d\n%s %d\n%s %d\n", SettingsFld_Rate, NRF_rate, SettingsFld_Ch, NRF_channel, SettingsFld_ESB, NRF_ESB); furi_string_cat_printf(str, "%s %d\n%s %d\n%s %d\n", SettingsFld_DPL, NRF_DPL, SettingsFld_CRC, NRF_CRC, SettingsFld_Payload, NRF_Payload); furi_string_cat_printf(str, "P0: "); add_to_furi_str_hex_bytes(str, (char*)addrs.addr_P0, addrs.addr_len); furi_string_cat(str, "\n"); if(addrs.addr_count > 1) { furi_string_cat_printf(str, "P1: "); add_to_furi_str_hex_bytes(str, (char*)addrs.addr_P1, addrs.addr_len); furi_string_cat(str, "\n"); } if(addrs.addr_count > 2) { furi_string_cat_printf(str, "P2: "); furi_string_cat_printf(str, "%02X\n", addrs.addr_P2); } if(addrs.addr_count > 3) { furi_string_cat_printf(str, "P3: "); furi_string_cat_printf(str, "%02X\n", addrs.addr_P3); } if(addrs.addr_count > 4) { furi_string_cat_printf(str, "P4: "); furi_string_cat_printf(str, "%02X\n", addrs.addr_P4); } if(addrs.addr_count > 5) { furi_string_cat_printf(str, "P5: "); furi_string_cat_printf(str, "%02X\n", addrs.addr_P5); } if(!(fl = stream_write_string(file_stream, str) == furi_string_size(str))) { FURI_LOG_E(TAG, "Failed to write header to file!"); notification_message(APP->notification, &sequence_blink_red_100); } } if(fl) { if(f_settings) { save_settings = 0; if(strcmp(addr_file_name, "NONE") == 0) strcpy(addr_file_name, SETTINGS_FILENAME); } else { int i = 0; for(; i < log_arr_idx; i++) { furi_string_reset(str); uint8_t *ptr = APP->log_arr + i * LOG_REC_SIZE; int len; if(ptr[0] & 0x80) { // RAW len = (ptr[1] & 0b11)+2 + ((ptr[1] & 0b100) ? 2 : 0) + (ptr[1] >> 3) + 2; // addr + PCF? + payload + crcmax } else { len = (ptr[1] >> 3); if(len == 0) len = 32; } if(len < NRF_Payload) len = NRF_Payload; add_to_furi_str_hex_bytes(str, (char*)ptr, len + 2); furi_string_cat(str, "\n"); if(stream_write_string(file_stream, str) != furi_string_size(str)) { FURI_LOG_E(TAG, "Failed to write to file!"); break; } } if(i == log_arr_idx) { notification_message(APP->notification, &sequence_blink_yellow_100); FURI_LOG_D(TAG, "File saved"); } save_to_new_log = false; } } file_stream_close(file_stream); } else { FURI_LOG_E(TAG, "Failed to open file %s", furi_string_get_cstr(str)); notification_message(APP->notification, &sequence_blink_red_100); } stream_free(file_stream); furi_string_free(str); } static bool select_settings_file(Stream* stream) { DialogsApp* dialogs = furi_record_open("dialogs"); bool result = false; FuriString* path; path = furi_string_alloc(); furi_string_set(path, SCAN_APP_PATH_FOLDER); DialogsFileBrowserOptions browser_options; dialog_file_browser_set_basic_options(&browser_options, ".txt", NULL); browser_options.hide_ext = false; bool ret = dialog_file_browser_show(dialogs, path, path, &browser_options); furi_record_close("dialogs"); if(ret) { if(!file_stream_open(stream, furi_string_get_cstr(path), FSAM_READ, FSOM_OPEN_EXISTING)) { FURI_LOG_D(TAG, "Cannot open file \"%s\"", furi_string_get_cstr(path)); file_stream_close(stream); } else { FURI_LOG_D(TAG, "Open file \"%s\"", furi_string_get_cstr(path)); strncpy(addr_file_name, furi_string_get_cstr(path) + sizeof(SCAN_APP_PATH_FOLDER), sizeof(addr_file_name)); result = true; } } furi_string_free(path); return result; } // 0 - success, otherwise an error static uint8_t load_settings_file(Stream* file_stream) { size_t file_size = 0; char* file_buf; uint8_t err = 5; file_size = stream_size(file_stream); if(file_size == (size_t)0) { FURI_LOG_D(TAG, "load failed. file_size: %d", file_size); return 1; } file_size = MIN(file_size, (size_t) LOG_REC_SIZE * MAX_LOG_RECORDS * 2 + 100); file_buf = malloc(file_size + 1); if(file_buf == NULL) { FURI_LOG_D(TAG, "Memory low, need: %d", file_size); return 2; } memset(file_buf, 0, file_size + 1); if(stream_read(file_stream, (uint8_t*)file_buf, file_size) == file_size) { FURI_LOG_D(TAG, "Loading settings file"); char* line_ptr = file_buf; int16_t line_num = 0; memset((uint8_t*)&addrs, 0, sizeof(addrs)); what_to_do = 2; bool log_loaded = false; while(line_ptr && (size_t)(line_ptr - file_buf) < file_size) { char* end_ptr = strstr((char*)line_ptr, "\n"); if(end_ptr == NULL) end_ptr = file_buf + file_size; else *end_ptr = '\0'; int line_len = end_ptr - line_ptr; if(*line_ptr == '\r' || line_len == 0) { line_ptr = end_ptr + 1; continue; } if(*(end_ptr - 1) < '0') { *(end_ptr - 1) = '\0'; line_len--; } //FURI_LOG_D(TAG, " L#%d: [%d]%s", line_num, line_len, line_ptr); if(strncmp(line_ptr, SettingsFld_Rate, sizeof(SettingsFld_Rate)-1) == 0) { NRF_rate = atoi(line_ptr + sizeof(SettingsFld_Rate)); } else if(strncmp(line_ptr, SettingsFld_Ch, sizeof(SettingsFld_Ch)-1) == 0) { NRF_channel = atoi(line_ptr + sizeof(SettingsFld_Ch)); } else if(strncmp(line_ptr, SettingsFld_ESB, sizeof(SettingsFld_ESB)-1) == 0) { NRF_ESB = atoi(line_ptr + sizeof(SettingsFld_ESB)); } else if(strncmp(line_ptr, SettingsFld_DPL, sizeof(SettingsFld_DPL)-1) == 0) { NRF_DPL = atoi(line_ptr + sizeof(SettingsFld_DPL)); } else if(strncmp(line_ptr, SettingsFld_CRC, sizeof(SettingsFld_CRC)-1) == 0) { NRF_CRC = atoi(line_ptr + sizeof(SettingsFld_CRC)); if(what_to_do == 1) view_log_decode_CRC = NRF_CRC; } else if(strncmp(line_ptr, SettingsFld_Payload, sizeof(SettingsFld_Payload)-1) == 0) { NRF_Payload = atoi(line_ptr + sizeof(SettingsFld_Payload)); if(NRF_Payload == 0 || NRF_Payload > 32) NRF_Payload = 32; } else if(strncmp(line_ptr, SettingsFld_Sniff, sizeof(SettingsFld_Sniff)-1) == 0) { what_to_do = 1; } else if(*line_ptr == SettingsFld_Addr) { char a = *(++line_ptr); line_ptr += 3; switch(a) { case '0': addrs.addr_len = ConvertHexToArray(line_ptr, addrs.addr_P0, what_to_do == 1 ? 3 : 5); //FURI_LOG_D(TAG, " +Addr(%d): %02X%02X%02X...", addrs.addr_len, addrs.addr_P0[0], addrs.addr_P0[1], addrs.addr_P0[2]); if(addrs.addr_len >= 2) err = 0; break; case '1': ConvertHexToArray(line_ptr, addrs.addr_P1, what_to_do == 1 ? 3 : 5); //FURI_LOG_D(TAG, " +Addr: %02X%02X%02X...", addrs.addr_P0[1], addrs.addr_P1[1], addrs.addr_P1[2]); break; case '2': ConvertHexToArray(line_ptr, &addrs.addr_P2, 1); break; case '3': ConvertHexToArray(line_ptr, &addrs.addr_P3, 1); break; case '4': ConvertHexToArray(line_ptr, &addrs.addr_P4, 1); break; case '5': ConvertHexToArray(line_ptr, &addrs.addr_P5, 1); break; default: a = 0; break; } if(err == 0 && a) addrs.addr_count = a - '0' + 1; } else if(line_len >= 3 * 2) { // data if(!log_loaded) { clear_log(); what_to_do = 0; log_loaded = true; } if(log_arr_idx < MAX_LOG_RECORDS - 1) { ConvertHexToArray(line_ptr, APP->log_arr + log_arr_idx * LOG_REC_SIZE, LOG_REC_SIZE); log_arr_idx++; } } line_ptr = end_ptr + 1; line_num++; } } else { FURI_LOG_D(TAG, "load failed. file size: %d", file_size); err = 4; } free(file_buf); return err; } static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) { furi_assert(event_queue); PluginEvent event = {.type = EventTypeKey, .input = *input_event}; furi_message_queue_put(event_queue, &event, FuriWaitForever); } static void prepare_nrf24(bool fsend_packet) { nrf24_write_reg(nrf24_HANDLE, REG_STATUS, 0x70); // clear interrupts nrf24_write_reg(nrf24_HANDLE, REG_RF_SETUP, NRF_rate); uint8_t erx_addr = (1<<0); // Enable RX_P0 if(!fsend_packet) { if(addrs.addr_count == 0) return; uint8_t payload = NRF_Payload; if(what_to_do == 1) { // SNIFF payload += 5 + NRF_CRC; // + addr_max + CRC if(NRF_ESB) payload += 2; if(payload > 32) payload = 32; nrf24_write_reg(nrf24_HANDLE, REG_CONFIG, 0x70); // Mask all interrupts nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, 0); // Automatic Retransmission nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0); // Auto acknowledgement nrf24_write_reg(nrf24_HANDLE, REG_FEATURE, 0); // Enables the W_TX_PAYLOAD_NOACK command, Disable Payload with ACK, set Dynamic Payload } else { nrf24_write_reg(nrf24_HANDLE, REG_CONFIG, 0x70 | ((NRF_CRC == 1 ? 0b1000 : NRF_CRC == 2 ? 0b1100 : 0))); // Mask all interrupts nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, NRF_ESB ? 0x11 : 0); // Automatic Retransmission nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, NRF_AA_OFF || !NRF_ESB ? 0 : 0x3F); // Auto acknowledgement nrf24_write_reg(nrf24_HANDLE, REG_FEATURE, NRF_DPL ? 4+1 : 1); // Enables the W_TX_PAYLOAD_NOACK command, Disable Payload with ACK, set Dynamic Payload } nrf24_set_maclen(nrf24_HANDLE, addrs.addr_len); nrf24_set_mac(REG_RX_ADDR_P0, addrs.addr_P0, addrs.addr_len); uint8_t tmp[5] = { 0 }; nrf24_read_reg(nrf24_HANDLE, REG_RX_ADDR_P0, tmp, addrs.addr_len); for(uint8_t i = 0; i < addrs.addr_len / 2; i++) { uint8_t tb = tmp[i]; tmp[i] = tmp[addrs.addr_len - i - 1]; tmp[addrs.addr_len - i - 1] = tb; } NRF_ERROR = memcmp(addrs.addr_P0, tmp, addrs.addr_len) != 0; FURI_LOG_D(TAG, "Payload: %d", payload); nrf24_write_reg(nrf24_HANDLE, RX_PW_P0, payload); if(addrs.addr_count > 1) { nrf24_set_mac(REG_RX_ADDR_P1, addrs.addr_P1, addrs.addr_len); nrf24_write_reg(nrf24_HANDLE, RX_PW_P1, payload); erx_addr |= (1<<1); // Enable RX_P1 } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P1, 0); if(addrs.addr_count > 2) { nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P2, &addrs.addr_P2, 1); nrf24_write_reg(nrf24_HANDLE, RX_PW_P2, payload); erx_addr |= (1<<2); // Enable RX_P2 } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P2, 0); if(addrs.addr_count > 3) { nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P3, &addrs.addr_P3, 1); nrf24_write_reg(nrf24_HANDLE, RX_PW_P3, payload); erx_addr |= (1<<3); // Enable RX_P3 } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P3, 0); if(addrs.addr_count > 4) { nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P4, &addrs.addr_P4, 1); nrf24_write_reg(nrf24_HANDLE, RX_PW_P4, payload); erx_addr |= (1<<4); // Enable RX_P4 } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P4, 0); if(addrs.addr_count > 5) { nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P5, &addrs.addr_P5, 1); nrf24_write_reg(nrf24_HANDLE, RX_PW_P5, payload); erx_addr |= (1<<5); // Enable RX_P5 } else nrf24_write_reg(nrf24_HANDLE, RX_PW_P5, 0); nrf24_write_reg(nrf24_HANDLE, REG_DYNPD, NRF_DPL ? 0x3F : 0); // Enable dynamic payload reg nrf24_write_reg(nrf24_HANDLE, REG_EN_RXADDR, erx_addr); nrf24_write_reg(nrf24_HANDLE, REG_RF_CH, NRF_channel); } nrf24_flush_rx(nrf24_HANDLE); nrf24_flush_tx(nrf24_HANDLE); nrf24_set_idle(nrf24_HANDLE); } static void start_scanning() { FURI_LOG_D(TAG, "Start proc-%d: Ch=%d Rate=%d", what_to_do, NRF_channel, NRF_rate); if(what_to_do == 1) { NRF_Sniff_payload_max = 32 - 3 - (NRF_ESB ? 2 : 0) - NRF_CRC + (addrs.addr_len - 2); if(NRF_Payload > NRF_Sniff_payload_max) NRF_Payload = NRF_Sniff_payload_max; view_log_decode_CRC = NRF_CRC; } prepare_nrf24(false); if(NRF_ERROR) { FURI_LOG_E(TAG, "NRF R/W ERROR!"); return; } nrf24_set_rx_mode(nrf24_HANDLE); start_time = furi_get_tick(); } // start bitnum = 7 uint16_t calc_crc(uint32_t crc, uint8_t *ptr, uint8_t bitnum, uint16_t bits) { //uint8_t bitnum = 7; uint32_t crc_high, polynom; if(view_log_decode_CRC == 2) { crc_high = (1<<16); polynom = 0x11021; // X^16+X^12+X^5+1 } else { crc_high = (1<<8); polynom = 0x107; // x^8+x^2+x^1+1 } while(bits--) { crc <<= 1; if(((crc & crc_high) != 0) ^ ((*ptr >> bitnum) & 1)) crc ^= polynom; if(bitnum == 0) { ptr++; bitnum = 7; } else bitnum--; } return crc & (view_log_decode_CRC == 2 ? 0xFFFF : 0xFF); } // shifted 1 bit right uint16_t get_shifted_crc(uint8_t *pcrc) { uint16_t crc = ((uint8_t)(*pcrc << 1)) | (*(pcrc+1) >> 7); if(view_log_decode_CRC == 2) { crc = (crc << 8) | (((uint8_t)(*(pcrc+1) << 1))) | (*(pcrc+2) >> 7); } return crc; } bool check_packet(uint8_t *pkt, uint8_t size) { if(furi_log_get_level() == FuriLogLevelDebug) { char dbuf[65]; dbuf[0] = 0; add_to_str_hex_bytes(dbuf, (char*)pkt, size); FURI_LOG_D(TAG, "PKT%d: %s (%d)", *(pkt - 1), dbuf, size); } for(uint8_t addr_size = 3; addr_size <= 5; addr_size++) { if(NRF_ESB){ uint8_t b = *(pkt + addr_size) >> 2; if((b > NRF_Payload - (addr_size - 3) && b != 0x33)) continue; if(b != 0x33) { // DPL uint16_t crc = view_log_decode_CRC == 2 ? 0xFFFF : 0xFF; crc = calc_crc(crc, pkt, 7, 9 + (b + addr_size) * 8); //FURI_LOG_D(TAG, "DCRC: %X - %X", crc, get_shifted_crc(pkt + b + 1)); if(crc == get_shifted_crc(pkt + b + addr_size + 1)) { *(pkt - 1) = ((b & 0x1F) << 3) + 0b100 + (addr_size - 2); FURI_LOG_D(TAG, "VALID CRC %X: dpl: %d, addr: %d", crc, b, addr_size); return true; } } else { for(uint8_t i = 0; i < size - view_log_decode_CRC; i++) { uint16_t crc = view_log_decode_CRC == 2 ? 0xFFFF : 0xFF; crc = calc_crc(crc, pkt, 7, (addr_size + i) * 8 + 9); //FURI_LOG_D(TAG, "CRC: %X - %X", crc, get_shifted_crc(pkt + addr_size + i + 1)); if(crc == get_shifted_crc(pkt + addr_size + i + 1)) { *(pkt - 1) = ((i & 0x1F) << 3) + 0b100 + (addr_size - 2); FURI_LOG_D(TAG, "VALID CRC %X: pl: %d, addr: %d", crc, i, addr_size); return true; } } } } else { for(uint8_t i = 0; i < size - view_log_decode_CRC; i++) { uint16_t crc = view_log_decode_CRC == 2 ? 0xFFFF : 0xFF; crc = calc_crc(crc, pkt, 7, (addr_size + i) * 8); if((view_log_decode_CRC == 1 && crc == *(pkt + addr_size + i + 1)) || (view_log_decode_CRC == 2 && crc == ((*(pkt + addr_size + i + 1)<<8) | *(pkt + addr_size + i + 2)))) { *(pkt - 1) = ((i & 0x1F) << 3) + 0b000 + (addr_size - 2); FURI_LOG_D(TAG, "VALID CRC %X: pl: %d, addr: %d", crc, i, addr_size); return true; } } } } return false; } bool nrf24_read_newpacket() { if(APP->log_arr == NULL) return false; bool found = false; uint8_t packetsize; uint8_t *ptr = APP->log_arr + log_arr_idx * LOG_REC_SIZE; uint8_t st = nrf24_rxpacket(nrf24_HANDLE, ptr + 2 + (what_to_do == 1 ? addrs.addr_len - 2 : 0), &packetsize, !NRF_DPL); if(st & RX_DR) { st = (st >> 1) & 7; // pipe # if(what_to_do == 1) { *ptr++ = NRF_channel | 0x80; *ptr++ = st; // pipe # if(addrs.addr_len > 2) { *ptr = st == 0 ? addrs.addr_P0[2] : st == 1 ? addrs.addr_P1[2] : st == 2 ? addrs.addr_P2 : st == 3 ? addrs.addr_P3 : st == 4 ? addrs.addr_P4 : addrs.addr_P5; } else { if(*ptr == 0x55 || *ptr == 0xAA || *ptr == 0x00 || *ptr == 0xFF) return found; // skip pkt when address begin with } if(!check_packet(ptr, packetsize)) { if(addrs.addr_len > 2) return false; // skip if mac MSB added to preamble if(addrs.addr_count == 1 && addrs.addr_P0[1] == 0xAA) { // Shift packet right by one bit if preamble = 0xAA for(uint8_t i = packetsize - 1; i > 0; i--) { ptr[i] = ptr[i - 1] << 7 | ptr[i] >> 1; } *ptr >>= 1; //if((st == 0 && (addrs.addr_P0[1] & 1)) || (st == 1 && (addrs.addr_P1[1] & 1))) *ptr |= 0x80; if(!check_packet(ptr, packetsize)) return false; } else return false; } } else { *ptr++ = NRF_channel; *ptr++ = ((packetsize & 0x1F) << 3) | st; // payload size + pipe # } if(packetsize < 32) memset(ptr + packetsize, 0, 32 - packetsize); if(log_arr_idx < MAX_LOG_RECORDS - 1) { log_arr_idx++; } else { if(log_to_file == 1 || log_to_file == 2) { write_to_log_file(APP->storage, false); clear_log(); } else { memmove(APP->log_arr, APP->log_arr + LOG_REC_SIZE, log_arr_idx * LOG_REC_SIZE); } } FURI_LOG_D(TAG, "Found packet #%d pipe %d", log_arr_idx, st); notification_message(APP->notification, &sequence_blink_white_100); found = true; } return found; } bool nrf24_send_packet() { if(log_arr_idx == 0) return false; prepare_nrf24(!what_to_do); uint8_t *ptr = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE; nrf24_write_reg(nrf24_HANDLE, REG_RF_CH, *ptr & 0x7F); if(*ptr & 0x80) { // RAW packet //uint8_t pktinfo = *(ptr + 1); //nrf24_set_maclen(nrf24_HANDLE, (pktinfo & 0b11) + 2); //if(pktinfo & 0b100) { // ESB nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, 0); // No Automatic Retransmission nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0); // No Auto acknowledgement //} //uint8_t alen = (*(ptr + 2) & 0b11) + 2; uint8_t adr[2]; adr[0] = ptr[2]; adr[1] = ptr[3]; nrf24_set_maclen(nrf24_HANDLE, 2); nrf24_set_mac(REG_RX_ADDR_P0, adr, 2); nrf24_set_mac(REG_TX_ADDR, adr, 2); last_packet_send_st = nrf24_txpacket(nrf24_HANDLE, ptr + 2 + 2, 32 - 2, false); } else { nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, NRF_ESB ? 0x11 : 0); // Automatic Retransmission nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, NRF_AA_OFF || !NRF_ESB ? 0 : 0x3F); // Auto acknowledgement uint8_t *adr; uint8_t a = *(ptr + 1) & 0b111; if(a < 2) { if(a == 0) adr = addrs.addr_P0; else adr = addrs.addr_P1; nrf24_set_mac(REG_RX_ADDR_P0, adr, addrs.addr_len); nrf24_set_mac(REG_TX_ADDR, adr, addrs.addr_len); } else { uint8_t buf[5]; memcpy(buf, addrs.addr_P1, addrs.addr_len - 1); buf[addrs.addr_len - 1] = a == 2 ? addrs.addr_P2 : a == 3 ? addrs.addr_P3 : a == 4 ? addrs.addr_P4 : addrs.addr_P5; nrf24_set_mac(REG_RX_ADDR_P0, buf, addrs.addr_len); nrf24_set_mac(REG_TX_ADDR, buf, addrs.addr_len); } a = *(ptr + 1) >> 3; if(a == 0) a = 32; nrf24_write_reg(nrf24_HANDLE, REG_CONFIG, 0x70 | ((NRF_CRC == 1 ? 0b1000 : NRF_CRC == 2 ? 0b1100 : 0))); // Mask all interrupts nrf24_write_reg(nrf24_HANDLE, REG_DYNPD, NRF_DPL ? 0x3F : 0); // Enable dynamic payload reg last_packet_send_st = nrf24_txpacket(nrf24_HANDLE, ptr + 2, a, false); } last_packet_send = view_log_arr_idx; notification_message(APP->notification, last_packet_send_st ? &sequence_blink_blue_100 : &sequence_blink_red_100); if(what_to_do) start_scanning(); return last_packet_send_st; } static void render_callback(Canvas* const canvas, void* ctx) { const PluginState* plugin_state = acquire_mutex((ValueMutex*)ctx, 25); if(plugin_state == NULL) return; //canvas_draw_frame(canvas, 0, 0, 128, 64); // border around the edge of the screen if(what_doing == 0) { canvas_set_font(canvas, FontSecondary); // 8x10 font if(save_settings) snprintf(screen_buf, sizeof(screen_buf), "Save: %s", SETTINGS_FILENAME); // menu_selected = 0 else snprintf(screen_buf, sizeof(screen_buf), "Load: %s", addr_file_name); canvas_draw_str(canvas, 10, 10, screen_buf); snprintf(screen_buf, sizeof(screen_buf), "Ch: %d", NRF_channel); // menu_selected = 1 canvas_draw_str(canvas, 10, 20, screen_buf); if(NRF_ESB) { strcpy(screen_buf, "ESB"); if(NRF_DPL) strcat(screen_buf, " DPL"); canvas_draw_str(canvas, 80, 20, screen_buf); } if(NRF_AA_OFF) { canvas_draw_str(canvas, 61, 20, "AA"); canvas_draw_line(canvas, 60, 21, 72, 12); } snprintf(screen_buf, sizeof(screen_buf), "Rate: %sbps", NRF_rate == 2 ? "2M" : NRF_rate == 1 ? "1M" : "250K"); // menu_selected = 2 canvas_draw_str(canvas, 10, 30, screen_buf); snprintf(screen_buf, sizeof(screen_buf), "Payload: %d", NRF_Payload); canvas_draw_str(canvas, 80, 30, screen_buf); strcpy(screen_buf, "Next Ch time: "); // menu_selected = 3 if(find_channel_period == 0) strcat(screen_buf, "off"); else snprintf(screen_buf + strlen(screen_buf), sizeof(screen_buf), "%d s", find_channel_period); canvas_draw_str(canvas, 10, 40, screen_buf); if(NRF_CRC == 1) canvas_draw_str(canvas, 99, 40, "CRC1"); else if(NRF_CRC == 2) canvas_draw_str(canvas, 99, 40, "CRC2"); snprintf(screen_buf, sizeof(screen_buf), "Log: %s", log_to_file == 0 ? "No" : log_to_file == 1 ? "Yes" : log_to_file == 2 ? "Append" : "Clear");// menu_selected = 4 canvas_draw_str(canvas, 10, 50, screen_buf); if(what_to_do) { // menu_selected = 5 if(NRF_ERROR) snprintf(screen_buf, sizeof(screen_buf), "nRF24L01+ R/W ERROR!"); else { if(what_to_do == 1) snprintf(screen_buf, sizeof(screen_buf), "Start sniff"); else snprintf(screen_buf, sizeof(screen_buf), "Start scan (pipes: %d)", addrs.addr_count); } } else snprintf(screen_buf, sizeof(screen_buf), "View log (pipes: %d)", addrs.addr_count); canvas_draw_str(canvas, 10, 60, screen_buf); canvas_draw_str(canvas, 0, menu_selected * 10 + 10, ">"); } else if(what_doing == 1){ canvas_set_font(canvas, FontBatteryPercent); // 5x7 font, 9 lines bool ch2 = false; screen_buf[0] = '\0'; if(view_log_arr_x == 0) { strcat(screen_buf, " "); ch2 = true; } else { snprintf(screen_buf, sizeof(screen_buf), "<%d", view_log_arr_x); if(view_log_arr_x < VIEW_LOG_MAX_X) ch2 = true; } snprintf(screen_buf + strlen(screen_buf), sizeof(screen_buf), " %s ch: %d - %d.", what_to_do == 1 ? "Sniff" : what_to_do == 2 ? "Read" : "View", NRF_channel, log_arr_idx); canvas_draw_str(canvas, 0, 7, screen_buf); if(ch2) canvas_draw_str(canvas, 121, 7, ">"); if(log_arr_idx) { if(view_log_arr_idx >= log_arr_idx) view_log_arr_idx = log_arr_idx - 1; uint16_t page = view_log_arr_idx & ~7; for(uint8_t i = 0; i < 8 && page + i < log_arr_idx; i++) { screen_buf[0] = (view_log_arr_idx & 7) != i ? ' ' : last_packet_send != view_log_arr_idx ? '>' : last_packet_send_st ? '*' : '!'; screen_buf[1] = '\0'; uint8_t *ptr = APP->log_arr + (page + i) * LOG_REC_SIZE; uint8_t channel = *ptr++; uint8_t *crcptr = NULL; uint8_t pre = 0; int count = 0; if(channel & 0x80) { // RAW packet: nn:>{.address..}-xxxxxxxx uint8_t pktinfo = *ptr++; bool _PCF = pktinfo & 0b100; uint8_t plen = count = (pktinfo >> 3); uint8_t adrsize = (pktinfo & 0b11) + 2; plen += adrsize; count += view_log_decode_CRC; if(view_log_arr_x > 0) count -= view_log_arr_x - 1; uint8_t max_width = VIEW_LOG_WIDTH_B; if(view_log_arr_x == 0) max_width -= 5; if(count > max_width) count = max_width; if(count > 0) { uint8_t *pcrc = ptr; uint16_t crc; crc = view_log_decode_CRC == 2 ? 0xFFFF : 0xFF; crc = calc_crc(crc, pcrc, 7, (_PCF? 9 : 0) + plen * 8); pcrc += plen; if(_PCF) { //ESB pcrc++; if(crc == get_shifted_crc(pcrc)) crcptr = pcrc; } else { if((view_log_decode_CRC == 1 && crc == *pcrc) || (view_log_decode_CRC == 2 && crc == ((*pcrc<<8) | *(pcrc+1)))) { crcptr = pcrc; } } if(view_log_arr_x == 0) { add_to_str_hex_bytes(screen_buf, (char*)ptr, adrsize); for(int8_t j = 5 - adrsize; j > 0; j--) strcat(screen_buf, " "); strcat(screen_buf, "-"); pre += 5 * 2 + 1; } else { ptr += view_log_arr_x - 1; } ptr += adrsize; if(_PCF) add_to_str_hex_bytes_shift_9b(screen_buf, (char*)ptr++, count); else add_to_str_hex_bytes(screen_buf, (char*)ptr, count); } } else { uint8_t dpl = *ptr++; uint8_t pipe = dpl & 0b111; dpl >>= 3; if(dpl == 0) dpl = 32; count = dpl - view_log_arr_x; if(view_log_decode_PCF) count--; uint8_t max_width = VIEW_LOG_WIDTH_B; if(view_log_arr_x == 0) { if(addrs.addr_count > 1) max_width--; if(view_log_decode_PCF) max_width -= 2; } if(count > max_width) count = max_width; if(count > 0) { if(view_log_decode_CRC) { static uint16_t prev_addr_CRC; static int8_t prev_pipe = -1; uint8_t *pcrc = ptr; uint16_t crc; if(prev_pipe == pipe) { crc = prev_addr_CRC; } else { crc = view_log_decode_CRC == 2 ? 0xFFFF : 0xFF; if(pipe <= 1) { crc = calc_crc(crc, pipe == 0 ? addrs.addr_P0 : addrs.addr_P1, 7, addrs.addr_len * 8); } else { crc = calc_crc(crc, addrs.addr_P1, 7, (addrs.addr_len - 1) * 8); crc = calc_crc(crc, pipe == 2 ? &addrs.addr_P2 : pipe == 3 ? &addrs.addr_P3 : pipe == 4 ? &addrs.addr_P4 : &addrs.addr_P5, 7, 8); } prev_addr_CRC = crc; prev_pipe = pipe; } if(view_log_decode_PCF) { crc = calc_crc(crc, pcrc++, 7, 9); if(crc == get_shifted_crc(pcrc)) crcptr = pcrc; if(crcptr == NULL) { for(int8_t j = 0; j < (int8_t)dpl - view_log_decode_CRC - 1; j++) { crc = calc_crc(crc, pcrc++, 6, 8); if(crc == get_shifted_crc(pcrc)) { crcptr = pcrc; break; } } } } else { for(int8_t j = 0; j < (int8_t)dpl - view_log_decode_CRC; j++) { crc = calc_crc(crc, pcrc++, 7, 8); if((view_log_decode_CRC == 1 && crc == *pcrc) || (view_log_decode_CRC == 2 && crc == ((*pcrc<<8) | *(pcrc+1)))) { crcptr = pcrc; break; } } } } } ptr += view_log_arr_x; if(max_width < VIEW_LOG_WIDTH_B) { pre += snprintf(screen_buf + 1, 10, "%X-", pipe); if(view_log_decode_PCF) { pre += snprintf(screen_buf + strlen(screen_buf), 10, "%02X%01X-", *ptr >> 2, ((*ptr & 3) << 1) | (*(ptr+1) >> 7)); } } if(view_log_decode_PCF) add_to_str_hex_bytes_shift_9b(screen_buf, (char*)ptr++, count); else add_to_str_hex_bytes(screen_buf, (char*)ptr, count); } uint16_t y = 14 + i * 7; canvas_draw_str(canvas, 3 * 5, y, screen_buf); uint16_t x = snprintf(screen_buf, sizeof(screen_buf), "%d", page + i + 1); canvas_draw_str(canvas, 0, y, screen_buf); if(crcptr) { // 5x7 font, 9 lines canvas_draw_str(canvas, x * 5, y, "="); int n = crcptr - (uint8_t*)ptr; if(n > -view_log_decode_CRC && n < count) { int len; x = (4 + pre) * 5; if(n < 0) { len = view_log_decode_CRC + n; n = 0; } else { len = MIN(view_log_decode_CRC, count - n); x += n * 2 * 5; canvas_draw_line(canvas, x - 1, y, x - 1, y - 1); } canvas_draw_line(canvas, x - 1, y, n = x + len * 2 * 5 - 1, y); canvas_draw_line(canvas, n, y, n, y - 1); } } else canvas_draw_str(canvas, x * 5, y, ":"); } } } else { canvas_set_font(canvas, FontBatteryPercent); // 5x7 font, 9 lines if(addrs.addr_count > 0) { snprintf(screen_buf, sizeof(screen_buf), "P0: "); add_to_str_hex_bytes(screen_buf, (char*)addrs.addr_P0, addrs.addr_len); canvas_draw_str(canvas, 0, 1 * 7, screen_buf); } if(addrs.addr_count > 1) { snprintf(screen_buf, sizeof(screen_buf), "P1: "); add_to_str_hex_bytes(screen_buf, (char*)addrs.addr_P1, addrs.addr_len); canvas_draw_str(canvas, 0, 2 * 7, screen_buf); } if(addrs.addr_count > 2) { canvas_draw_str(canvas, 0, 3 * 7, "P2: "); snprintf(screen_buf, sizeof(screen_buf), "%02X", addrs.addr_P2); canvas_draw_str(canvas, (4 + (addrs.addr_len - 1) * 2) * 5, 3 * 7, screen_buf); } if(addrs.addr_count > 3) { canvas_draw_str(canvas, 0, 4 * 7, "P3: "); snprintf(screen_buf, sizeof(screen_buf), "%02X", addrs.addr_P3); canvas_draw_str(canvas, (4 + (addrs.addr_len - 1) * 2) * 5, 4 * 7, screen_buf); } if(addrs.addr_count > 4) { canvas_draw_str(canvas, 0, 5 * 7, "P4: "); snprintf(screen_buf, sizeof(screen_buf), "%02X", addrs.addr_P4); canvas_draw_str(canvas, (4 + (addrs.addr_len - 1) * 2) * 5, 5 * 7, screen_buf); } if(addrs.addr_count > 5) { canvas_draw_str(canvas, 0, 6 * 7, "P5: "); snprintf(screen_buf, sizeof(screen_buf), "%02X", addrs.addr_P5); canvas_draw_str(canvas, (4 + (addrs.addr_len - 1) * 2) * 5, 6 * 7, screen_buf); } if(log_arr_idx) { uint8_t *ptr = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE; uint8_t pktinfo = *(ptr + 1); snprintf(screen_buf, 32, ">> Ch: %d, size: %d", *ptr & 0x7F, pktinfo >> 3); if(*ptr & 0x80) snprintf(screen_buf + strlen(screen_buf), 32, " RAW %s", (pktinfo & 0b100) ? "PCF" : ""); canvas_draw_str(canvas, 0, 7 * 7, screen_buf); } screen_buf[0] = 'v'; strcpy(screen_buf + 1, VERSION); canvas_draw_str(canvas, 108, 7, screen_buf); if(view_log_decode_PCF || view_log_decode_CRC) { strcpy(screen_buf, "Decode: "); if(view_log_decode_PCF) strcat(screen_buf, "PCF "); if(view_log_decode_CRC == 1) strcat(screen_buf, "CRC1"); else if(view_log_decode_CRC == 2) strcat(screen_buf, "CRC2"); canvas_draw_str(canvas, 0, 64, screen_buf); } } release_mutex((ValueMutex*)ctx, plugin_state); } int32_t nrf24scan_app(void* p) { UNUSED(p); APP = malloc(sizeof(Nrf24Scan)); APP->event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent)); APP->plugin_state = malloc(sizeof(PluginState)); ValueMutex state_mutex; if(!init_mutex(&state_mutex, APP->plugin_state, sizeof(PluginState))) { furi_message_queue_free(APP->event_queue); FURI_LOG_E(TAG, "cannot create mutex"); free(APP->plugin_state); return 255; } memset((uint8_t*)&addrs, 0, sizeof(addrs)); nrf24_init(); // Set system callbacks APP->view_port = view_port_alloc(); view_port_draw_callback_set(APP->view_port, render_callback, &state_mutex); view_port_input_callback_set(APP->view_port, input_callback, APP->event_queue); // Open GUI and register view_port APP->gui = furi_record_open(RECORD_GUI); gui_add_view_port(APP->gui, APP->view_port, GuiLayerFullscreen); APP->notification = furi_record_open(RECORD_NOTIFICATION); APP->storage = furi_record_open(RECORD_STORAGE); storage_common_mkdir(APP->storage, SCAN_APP_PATH_FOLDER); Stream* file_stream = file_stream_alloc(APP->storage); FuriString* path = furi_string_alloc(); furi_string_set(path, SCAN_APP_PATH_FOLDER); furi_string_cat(path, "/"); furi_string_cat(path, SNIFF_FILENAME); if(file_stream_open(file_stream, furi_string_get_cstr(path), FSAM_READ, FSOM_OPEN_EXISTING)) { uint8_t err = load_settings_file(file_stream); if(!err) strncpy(addr_file_name, furi_string_get_cstr(path) + sizeof(SCAN_APP_PATH_FOLDER), sizeof(addr_file_name)); else snprintf(addr_file_name, sizeof(addr_file_name), "LOAD ERROR#%d", err); } else { strcpy(addr_file_name, "NONE"); if(what_to_do == 1) { addrs.addr_P0[0] = 0; addrs.addr_P0[1] = 0xAA; addrs.addr_len = 2; addrs.addr_count = 1; view_log_decode_CRC = NRF_CRC = 2; } } file_stream_close(file_stream); stream_free(file_stream); furi_string_free(path); allocate_log_array(); PluginEvent event; for(bool processing = true; processing;) { FuriStatus event_status = furi_message_queue_get(APP->event_queue, &event, 100); PluginState* plugin_state = (PluginState*)acquire_mutex_block(&state_mutex); if(event_status == FuriStatusOk) { // press events if(event.type == EventTypeKey) { //FURI_LOG_D(TAG, "Key: %d Type: %d Sec: %u", event.input.key, event.input.type, event.input.sequence); switch(event.input.key) { case InputKeyUp: if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) { if(what_doing == 0) { if(menu_selected > 0) menu_selected--; else menu_selected = menu_selected_max; } else if(what_doing == 1) { view_log_arr_idx -= event.input.type == InputTypeRepeat ? 10 : 1; if(view_log_arr_idx >= log_arr_idx) view_log_arr_idx = 0; } } break; case InputKeyDown: if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) { if(what_doing == 0) { if(menu_selected < menu_selected_max) menu_selected++; else menu_selected = 0; } else if(what_doing == 1) { view_log_arr_idx += event.input.type == InputTypeRepeat ? 10 : 1; if(view_log_arr_idx >= log_arr_idx) view_log_arr_idx = log_arr_idx - 1; } } break; case InputKeyLeft: if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) { if(what_doing == 0) { switch(menu_selected) { case Menu_enter_channel: NRF_channel -= event.input.type == InputTypeRepeat ? 10 : 1; if(NRF_channel > MAX_CHANNEL) NRF_channel = MAX_CHANNEL; break; case Menu_enter_rate: NRF_Payload -= event.input.type == InputTypeRepeat ? 10 : 1; if(NRF_Payload == 0 || NRF_Payload > 32) NRF_Payload = 1; break; case Menu_enter_scan_period: find_channel_period -= event.input.type == InputTypeRepeat ? 10 : 1; if(find_channel_period < 0) find_channel_period = 0; break; case Menu_log: if(--log_to_file < -1) log_to_file = 2; break; case Menu_ok: if(++what_to_do > 2) what_to_do = 0; break; } } else if(what_doing == 1) { if(view_log_arr_x > 0) view_log_arr_x--; } else if(what_doing == 2) { //if(NRF_ESB == 0) view_log_decode_PCF ^= 1; } } break; case InputKeyRight: if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) { if(what_doing == 0) { switch(menu_selected) { case Menu_open_file: save_settings ^= 1; break; case Menu_enter_channel: NRF_channel += event.input.type == InputTypeRepeat ? 10 : 1; if(NRF_channel > MAX_CHANNEL) NRF_channel = 0; break; case Menu_enter_rate: NRF_Payload += event.input.type == InputTypeRepeat ? 10 : 1; if(NRF_Payload == 0 || NRF_Payload > 32) NRF_Payload = 32; break; case Menu_enter_scan_period: find_channel_period += event.input.type == InputTypeRepeat ? 10 : 1; break; case Menu_log: if(++log_to_file > 2) log_to_file = -1; break; case Menu_ok: if(++what_to_do > 2) what_to_do = 0; break; } } else if(what_doing == 1) { if(view_log_arr_x < VIEW_LOG_MAX_X) view_log_arr_x++; } else if(what_doing == 2) { if(++view_log_decode_CRC > 2) view_log_decode_CRC = 0; } } break; case InputKeyOk: if(event.input.type == InputTypeShort) { if(what_doing == 0) { switch(menu_selected) { case Menu_open_file: if(save_settings) { write_to_log_file(APP->storage, true); } else { file_stream = file_stream_alloc(APP->storage); if(select_settings_file(file_stream)) { uint8_t err = load_settings_file(file_stream); if(!err) save_to_new_log = true; else snprintf(addr_file_name, sizeof(addr_file_name), "LOAD ERROR#%d", err); file_stream_close(file_stream); menu_selected = Menu_ok; } stream_free(file_stream); } break; case Menu_enter_channel: if(NRF_ESB) { if(NRF_DPL) NRF_DPL = NRF_ESB = 0; else NRF_DPL = 1; } else NRF_ESB = 1; //if(NRF_ESB) view_log_decode_PCF = 0; break; case Menu_enter_rate: NRF_rate++; if(NRF_rate > 2) NRF_rate = 0; break; case Menu_enter_scan_period: if(++NRF_CRC > 2) NRF_CRC = what_to_do == 1 ? 1 : 0; break; case Menu_ok: if(what_to_do) { if(addrs.addr_count || what_to_do == 1) { if(log_to_file == -1) { log_to_file = 0; clear_log(); save_to_new_log = true; } else if(log_to_file == 1) save_to_new_log = true; start_scanning(); if(!NRF_ERROR) what_doing = 1; } } else what_doing = 1; key_press_seq_ok = event.input.sequence; break; } } else if(what_doing == 1) { nrf24_send_packet(); } } else if(event.input.type == InputTypeLong) { if(what_doing == 0) { if(menu_selected == Menu_enter_channel) { NRF_AA_OFF ^= 1; key_press_seq_ok = event.input.sequence; } else if(menu_selected == Menu_log) { // Log if(log_arr_idx && (log_to_file == 1 || log_to_file == 2)) { write_to_log_file(APP->storage, false); clear_log(); } } } else if(what_doing == 1) { what_doing = 2; } } break; case InputKeyBack: if(event.input.type == InputTypeLong) processing = false; else if(event.input.type == InputTypeShort) { if(what_doing) what_doing--; if(what_doing == 0) nrf24_set_idle(nrf24_HANDLE);; } break; default: break; } } } if(what_doing && what_to_do) { nrf24_read_newpacket(); if(find_channel_period && furi_get_tick() - start_time >= (uint32_t)find_channel_period * 1000UL) { if(++NRF_channel > MAX_CHANNEL) NRF_channel = 0; start_scanning(); } } view_port_update(APP->view_port); release_mutex(&state_mutex, plugin_state); } nrf24_set_idle(nrf24_HANDLE); if(log_arr_idx && (log_to_file == 1 || log_to_file == 2)) { write_to_log_file(APP->storage, false); } nrf24_deinit(); view_port_enabled_set(APP->view_port, false); gui_remove_view_port(APP->gui, APP->view_port); furi_record_close(RECORD_GUI); furi_record_close(RECORD_NOTIFICATION); furi_record_close(RECORD_STORAGE); view_port_free(APP->view_port); furi_message_queue_free(APP->event_queue); free(APP->plugin_state); if(APP->log_arr) free(APP->log_arr); free(APP); return 0; }