diff --git a/ReadMe.md b/ReadMe.md index 63145a2fb..51ed16e94 100644 --- a/ReadMe.md +++ b/ReadMe.md @@ -28,6 +28,7 @@ Thank you to all the supporters! - [PATREON ONLY UPDATES: For STOCK Animations Release: Desktop bar transparent, but the icons are shown](https://www.patreon.com/posts/76188388) - Swapped favorite buttons to fix Favorite location bug. - Updated: [Authenticator/TOTP (By akopachov)](https://github.com/akopachov/flipper-zero_authenticator) +- Updated: [NRF24 Scanner v2.1 (By vad7)](https://github.com/vad7/nrf24scan) ## Install from Release FLASH STOCK FIRST BEFORE UPDATING TO CUSTOM FIRMWARE! @@ -224,7 +225,7 @@ $ ./fbt resources icons dolphin_ext - [Music Player (By DrZlo13)-OFW](https://github.com/flipperdevices/flipperzero-firmware/pull/1189) - [NFC Magic (By gornekich)](https://github.com/flipperdevices/flipperzero-firmware/pull/1966) - [NRF Sniff (By mothball187)](https://github.com/mothball187/flipperzero-nrf24/tree/main/nrfsniff) ([Pin Out](https://github.com/RogueMaster/flipperzero-firmware-wPlugins/tree/420/applications/nrfsniff) from nocomp/Frog/UberGuidoZ) `Req: NRF24` -- [NRF24 Scanner v2.0 (By vad7)](https://github.com/vad7/nrf24scan) +- [NRF24 Scanner v2.1 (By vad7)](https://github.com/vad7/nrf24scan) - [Ocarina (By invalidna-me)](https://github.com/invalidna-me/flipperzero-ocarina) [Here are the LOTZ Songs](https://www.zeldadungeon.net/wiki/Ocarina_of_Time_Songs) - [Orgasmotron (By qqmajikpp)](https://github.com/qqmajikpp/flipperzero-firmware-wPlugins) - [Paint (By n-o-T-I-n-s-a-n-e)](https://github.com/n-o-T-I-n-s-a-n-e) diff --git a/applications/plugins/nrf24scan/README.md b/applications/plugins/nrf24scan/README.md index bc4838174..a93ec913e 100644 --- a/applications/plugins/nrf24scan/README.md +++ b/applications/plugins/nrf24scan/README.md @@ -16,7 +16,13 @@ ___________________________________________________________________________ В настройках задается минимальный размер нагрузки (payload)
После принятия, пакет сдвигается побитно и валидируется. Побитный сдвиг сильно увеличивает вероятность отлова пакета, но так же увеличивается количество мусорных пакетов.
Количество уникальных адресов запоминается (просмотр - стрелка вниз в режиме просмотра адресов)
-После поиска можно переключиться в режим сканирования по найденным адресам или сканировать адрес конкретного пакета - нажать ОК в режиме просмотра адресов
+После поиска можно переключиться в режим сканирования по найденным адресам или сканировать адрес конкретного пакета или группы адресов с различным LSB в адресе
+
+ +
+Адреса, которые попались дважды и более раз отображаются списком:
+ +

Изменение режима sniff/scan - стрелками на пункте Scan.

Режим сканирования (scan) - просто чтение пакетов по заданным в настройках мак адресам и виду пакета - ESB/DPL.
На начальном экране в режиме чтения можно загрузить файл настроек (по умолчанию загружается settings.txt из папки nrf24_scanner на SD карте).
diff --git a/applications/plugins/nrf24scan/Screenshot-6.png b/applications/plugins/nrf24scan/Screenshot-6.png new file mode 100644 index 000000000..7c9ecfc34 Binary files /dev/null and b/applications/plugins/nrf24scan/Screenshot-6.png differ diff --git a/applications/plugins/nrf24scan/Screenshot-7.png b/applications/plugins/nrf24scan/Screenshot-7.png new file mode 100644 index 000000000..579a88e06 Binary files /dev/null and b/applications/plugins/nrf24scan/Screenshot-7.png differ diff --git a/applications/plugins/nrf24scan/nrf24scan.c b/applications/plugins/nrf24scan/nrf24scan.c index 9f9a17398..b621fce28 100644 --- a/applications/plugins/nrf24scan/nrf24scan.c +++ b/applications/plugins/nrf24scan/nrf24scan.c @@ -2,7 +2,7 @@ // Written by vad7, 20.11.2022. // #include "nrf24scan.h" - + #include #include #include @@ -13,38 +13,38 @@ #include #include -#define TAG "nrf24scan" -#define VERSION "2.0" -#define MAX_CHANNEL 125 -#define MAX_ADDR 6 +#define TAG "nrf24scan" +#define VERSION "2.1" +#define MAX_CHANNEL 125 +#define MAX_ADDR 6 -#define SCAN_APP_PATH_FOLDER "/ext/apps_data/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 200 -#define MAX_FOUND_RECORDS 100 -#define LOG_REC_SIZE 34 // max packet size -#define VIEW_LOG_MAX_X 22 -#define VIEW_LOG_WIDTH_B 10 // bytes +#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 200 +#define MAX_FOUND_RECORDS 70 +#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:"; @@ -57,39 +57,38 @@ 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, 3 - view & read selected addr +uint8_t what_to_do = 1; // 0 - view, 1 - view & sniff, 2 - view & read, 3 - view & read selected addr uint8_t save_settings = 0; char screen_buf[64]; char addr_file_name[32]; -uint8_t NRF_rate = 2; // 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; // Payload len in bytes or Minimum payload in sniff mode, 0..32 +uint8_t NRF_rate = 2; // 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;// Payload len in bytes or Minimum payload in sniff mode, 0..32 uint8_t NRF_Payload_sniff_min = 0; -uint8_t NRF_AA_OFF = 0; // Disable Auto Acknowledgement +uint8_t NRF_AA_OFF = 0; // Disable Auto Acknowledgement bool NRF_ERROR = 0; struct ADDRS { - 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; + 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; }; struct ADDRS addrs; struct ADDRS addrs_sniff; bool sniff_loaded = 0; int16_t found_total; -int16_t view_found = -1; +int16_t view_found; -int8_t log_to_file = 0; // 0 - no, 1 - yes(new), 2 - append, -1 - only clear +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; @@ -98,744 +97,616 @@ 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 +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 + 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); +static void add_to_str_hex_bytes_shift_9b(char *out, char *arr, int bytes) +{ + if(bytes <= 0) return; + out += strlen(out); + arr++; // +8b + do { + snprintf(out, 4, "%02X", ((uint8_t)(*arr << 1)) | (*(arr+1) >> 7)); + arr++; + out += 2; + } while(--bytes); } -void clear_log() { - log_arr_idx = 0; - view_log_arr_idx = 0; - last_packet_send = -1; - found_total = 0; - view_found = 0; +void clear_log() +{ + log_arr_idx = 0; + view_log_arr_idx = 0; + last_packet_send = -1; + found_total = 0; + view_found = -1; } -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_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, - what_to_do == 1 ? NRF_Payload_sniff_min : 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); +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_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, what_to_do == 1 ? NRF_Payload_sniff_min : 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); + 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; + 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); + 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; + 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; - what_to_do = 2; - sniff_loaded = 0; - 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) { - uint8_t pld = atoi(line_ptr + sizeof(SettingsFld_Payload)); - if(pld > 32) pld = 32; - if(sniff_loaded) { - NRF_Payload_sniff_min = pld; - } else { - if(pld == 0) pld = 32; - NRF_Payload = pld; - } - } else if(strncmp(line_ptr, SettingsFld_Sniff, sizeof(SettingsFld_Sniff) - 1) == 0) { - what_to_do = 1; - sniff_loaded = 1; - } else if(*line_ptr == SettingsFld_Addr) { - char a = *(++line_ptr); - struct ADDRS* adr = sniff_loaded ? &addrs_sniff : &addrs; - line_ptr += 3; - switch(a) { - case '0': - memset(adr, 0, sizeof(addrs)); - adr->addr_len = - ConvertHexToArray(line_ptr, adr->addr_P0, sniff_loaded ? 3 : 5); - if(adr->addr_len >= 2) err = 0; - break; - case '1': - ConvertHexToArray(line_ptr, adr->addr_P1, what_to_do == 1 ? 3 : 5); - break; - case '2': - ConvertHexToArray(line_ptr, &adr->addr_P2, 1); - break; - case '3': - ConvertHexToArray(line_ptr, &adr->addr_P3, 1); - break; - case '4': - ConvertHexToArray(line_ptr, &adr->addr_P4, 1); - break; - case '5': - ConvertHexToArray(line_ptr, &adr->addr_P5, 1); - break; - default: - a = 0; - break; - } - if(err == 0 && a) adr->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; + 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; + what_to_do = 2; + sniff_loaded = 0; + 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) { + uint8_t pld = atoi(line_ptr + sizeof(SettingsFld_Payload)); + if(pld > 32) pld = 32; + if(sniff_loaded) { + NRF_Payload_sniff_min = pld; + } else { + if(pld == 0) pld = 32; + NRF_Payload = pld; + } + } else if(strncmp(line_ptr, SettingsFld_Sniff, sizeof(SettingsFld_Sniff)-1) == 0) { + what_to_do = 1; + sniff_loaded = 1; + } else if(*line_ptr == SettingsFld_Addr) { + char a = *(++line_ptr); + struct ADDRS *adr = sniff_loaded ? &addrs_sniff : &addrs; + line_ptr += 3; + switch(a) { + case '0': + memset(adr, 0, sizeof(addrs)); + adr->addr_len = ConvertHexToArray(line_ptr, adr->addr_P0, sniff_loaded ? 3 : 5); + if(adr->addr_len >= 2) err = 0; + break; + case '1': + ConvertHexToArray(line_ptr, adr->addr_P1, what_to_do == 1 ? 3 : 5); + break; + case '2': + ConvertHexToArray(line_ptr, &adr->addr_P2, 1); + break; + case '3': + ConvertHexToArray(line_ptr, &adr->addr_P3, 1); + break; + case '4': + ConvertHexToArray(line_ptr, &adr->addr_P4, 1); + break; + case '5': + ConvertHexToArray(line_ptr, &adr->addr_P5, 1); + break; + default: + a = 0; + break; + } + if(err == 0 && a) adr->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); + 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 - struct ADDRS* adr = what_to_do == 1 ? &addrs_sniff : &addrs; - if(!fsend_packet) { - uint8_t payload = NRF_Payload; - if(what_to_do == 1) { // SNIFF - if(adr->addr_count == 0) return; - //payload += 5 + NRF_CRC; // + addr_max + CRC - //if(NRF_ESB) payload += 2; - //if(payload > 32) 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 if(what_to_do == 2) { - if(adr->addr_count == 0) return; - 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 ? 0x01 : 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 - } - if(what_to_do == 3) { - uint8_t* p = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE; - uint8_t addr_size = (*(p + 1) & 0b11) + 2; - nrf24_set_maclen(nrf24_HANDLE, addr_size); - nrf24_set_mac(REG_RX_ADDR_P0, p + 2, addr_size); - memcpy(addrs.addr_P0, p + 2, addr_size); - addrs.addr_count = 1; - addrs.addr_len = addr_size; - nrf24_write_reg(nrf24_HANDLE, RX_PW_P0, *(p + 1) >> 3); - nrf24_write_reg(nrf24_HANDLE, REG_EN_RXADDR, erx_addr); - nrf24_write_reg(nrf24_HANDLE, REG_RF_CH, *p & 0x7F); - nrf24_write_reg( - nrf24_HANDLE, - REG_CONFIG, - 0x70 | ((NRF_CRC == 1 ? 0b1000 : - NRF_CRC == 2 ? 0b1100 : - 0))); // Mask all interrupts - if(*(p + 1) & 0b100) { // ESB - nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, 0x01); // Automatic Retransmission - nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0x3F); // Auto acknowledgement - nrf24_write_reg( - nrf24_HANDLE, - REG_FEATURE, - *(p + 2 + addr_size) >> 2 != 0x33 ? - 4 + 1 : - 1); // Enables the W_TX_PAYLOAD_NOACK command, Disable Payload with ACK, set Dynamic Payload - } else { - nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, 0); // Automatic Retransmission - nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0); // Auto acknowledgement - } - } else { - nrf24_set_maclen(nrf24_HANDLE, adr->addr_len); - nrf24_set_mac(REG_RX_ADDR_P0, adr->addr_P0, adr->addr_len); - uint8_t tmp[5] = {0}; - nrf24_read_reg(nrf24_HANDLE, REG_RX_ADDR_P0, tmp, adr->addr_len); - for(uint8_t i = 0; i < adr->addr_len / 2; i++) { - uint8_t tb = tmp[i]; - tmp[i] = tmp[adr->addr_len - i - 1]; - tmp[adr->addr_len - i - 1] = tb; - } - NRF_ERROR = memcmp(adr->addr_P0, tmp, adr->addr_len) != 0; - FURI_LOG_D(TAG, "Payload: %d", payload); - nrf24_write_reg(nrf24_HANDLE, RX_PW_P0, payload); - if(adr->addr_count > 1) { - nrf24_set_mac(REG_RX_ADDR_P1, adr->addr_P1, adr->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(adr->addr_count > 2) { - nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P2, &adr->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(adr->addr_count > 3) { - nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P3, &adr->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(adr->addr_count > 4) { - nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P4, &adr->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(adr->addr_count > 5) { - nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P5, &adr->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); -} - -void correct_NRF_Payload_sniff_min() { - uint8_t pld = 32 - 3 - (NRF_ESB ? 2 : 0) - NRF_CRC + (addrs_sniff.addr_len - 2); - if(NRF_Payload_sniff_min > pld) NRF_Payload_sniff_min = pld; -} - -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) { // SNIFF - correct_NRF_Payload_sniff_min(); - view_log_decode_CRC = NRF_CRC; - } else if(sniff_loaded) { // Switch from sniff to scan/view - // to do... - } - 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(); -} - -/* -bool check_addr_found(uint8_t *pkt) +void check_add_addr(uint8_t *pkt) { - uint8_t idx = 255; - if(addrs_found.addr_count > 0 && memcmp(addrs_found.addr_P0, pkt, addrs_found.addr_len) == 0) { idx = 0; goto x_end; } - if(addrs_found.addr_count > 1 && memcmp(addrs_found.addr_P1, pkt, addrs_found.addr_len - 1) == 0) { - if(addrs_found.addr_P1[addrs_found.addr_len - 1] == pkt[addrs_found.addr_len - 1]) { idx = 1; goto x_end; } - if(addrs_found.addr_count > 2 && addrs_found.addr_P2 == pkt[addrs_found.addr_len - 1]) { idx = 2; goto x_end; } - if(addrs_found.addr_count > 3 && addrs_found.addr_P3 == pkt[addrs_found.addr_len - 1]) { idx = 3; goto x_end; } - if(addrs_found.addr_count > 4 && addrs_found.addr_P4 == pkt[addrs_found.addr_len - 1]) { idx = 4; goto x_end; } - if(addrs_found.addr_count > 5 && addrs_found.addr_P5 == pkt[addrs_found.addr_len - 1]) { idx = 5; goto x_end; } + if(addrs.addr_count > 0 && memcmp(addrs.addr_P0, pkt, addrs.addr_len) == 0) return; + if(addrs.addr_count > 1 && memcmp(addrs.addr_P1, pkt, addrs.addr_len - 1) == 0) { + if(addrs.addr_P1[addrs.addr_len - 1] == pkt[addrs.addr_len - 1]) return; + if(addrs.addr_count > 2 && addrs.addr_P2 == pkt[addrs.addr_len - 1]) return; + if(addrs.addr_count > 3 && addrs.addr_P3 == pkt[addrs.addr_len - 1]) return; + if(addrs.addr_count > 4 && addrs.addr_P4 == pkt[addrs.addr_len - 1]) return; + if(addrs.addr_count > 5 && addrs.addr_P5 == pkt[addrs.addr_len - 1]) return; } -x_end: - if(idx < sizeof(found_total) / sizeof(found_total[0])) { - found_total[idx]++; - return true; - } else return false; -} -*/ - -// start bitnum = 7 -uint32_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 = 0x1021; // X^16+X^12+X^5+1 => 0x11021 & 0xFFFF = 0x1021 - } else { - crc_high = (1 << 8); - polynom = 0x07; // x^8+x^2+x^1+1 => 0x107 & 0xFF = 0x07 - } - 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); + if(addrs.addr_count == 1) memcpy(addrs.addr_P1, pkt, addrs.addr_len); + else if(addrs.addr_count == 2) addrs.addr_P2 = pkt[addrs.addr_len - 1]; + else if(addrs.addr_count == 3) addrs.addr_P3 = pkt[addrs.addr_len - 1]; + else if(addrs.addr_count == 4) addrs.addr_P4 = pkt[addrs.addr_len - 1]; + else if(addrs.addr_count == 5) addrs.addr_P5 = pkt[addrs.addr_len - 1]; + addrs.addr_count++; } -// shifted 1 bit right -uint32_t get_shifted_crc(uint8_t* pcrc) { - uint32_t crc = ((*pcrc << 1) & 0xFF) | (*(pcrc + 1) >> 7); - if(view_log_decode_CRC == 2) { - crc = (crc << 8) | ((*(pcrc + 1) << 1) & 0xFF) | (*(pcrc + 2) >> 7); - } - return crc; -} - -bool check_packet(uint8_t* pkt, uint16_t size) { - if(size < 3 || size > 32) return false; - uint8_t b = *pkt; - if(b == 0x55 || b == 0xAA || b == 0x00 || b == 0xFF) - return false; // skip pkt when address begin with - uint32_t prevcrc = 0xFFFFFFFF; - bool found = false; - uint8_t addr_size = 3; - for(; addr_size <= 5; addr_size++) { - if(NRF_ESB) { - uint8_t _payload = *(pkt + addr_size) >> 2; - if((_payload > size - addr_size - 2 - view_log_decode_CRC && _payload != 0x33)) - continue; - uint8_t* p = pkt + addr_size; - if(prevcrc == 0xFFFFFFFF) { - prevcrc = calc_crc( - view_log_decode_CRC == 2 ? 0xFFFF : 0xFF, - pkt, - 7, - 3 * 8); // crc for smallest addr - } - uint32_t crc; - if(addr_size > 3) - crc = calc_crc(prevcrc, p - (addr_size - 3), 7, 8 * (addr_size - 3)); - else - crc = prevcrc; - if(_payload != 0x33) { // DPL - crc = calc_crc(crc, p, 7, 9 + _payload * 8); - if(crc == get_shifted_crc(p + _payload + 1)) { - *(pkt - 1) = ((_payload & 0x1F) << 3) + 0b100 + (addr_size - 2); - FURI_LOG_D( - TAG, "VALID CRC %X: dpl: %d, addr: %d", (uint16_t)crc, _payload, addr_size); - found = true; - break; - } - } else { - crc = calc_crc(crc, p++, 7, 9); // PCF - if(crc == get_shifted_crc(p)) { - _payload = 0; - found = true; - } else { - for(uint8_t i = 1; i < size - addr_size - view_log_decode_CRC; i++) { - crc = calc_crc(crc, p++, 6, 8); - if(crc == get_shifted_crc(p)) { - _payload = i; - found = true; - break; - } - } - } - if(found) { - *(pkt - 1) = ((_payload & 0x1F) << 3) + 0b100 + (addr_size - 2); - FURI_LOG_D( - TAG, "VALID CRC %X: pl: %d, addr: %d", (uint16_t)crc, _payload, addr_size); - break; - } - } - } else { - uint8_t* p; - if(addr_size == 3) { - prevcrc = calc_crc( - view_log_decode_CRC == 2 ? 0xFFFF : 0xFF, - pkt, - 7, - 3 * 8); // crc for smallest addr - p = pkt + addr_size; - } else { - p = pkt + addr_size - 1; - prevcrc = calc_crc(prevcrc, p++, 7, 8); - } - uint32_t crc = prevcrc; - if((view_log_decode_CRC == 1 && crc == *p) || - (view_log_decode_CRC == 2 && crc == (uint32_t)((*p << 8) | *(p + 1)))) { - *(pkt - 1) = ((0 & 0x1F) << 3) + 0b000 + (addr_size - 2); - FURI_LOG_D(TAG, "VALID CRC %X: pl: %d, addr: %d", (uint16_t)crc, 0, addr_size); - found = true; - break; - } - for(uint8_t i = 1; i <= size - addr_size - view_log_decode_CRC; i++) { - crc = calc_crc(crc, p++, 7, 8); - if((view_log_decode_CRC == 1 && crc == *p) || - (view_log_decode_CRC == 2 && crc == (uint32_t)((*p << 8) | *(p + 1)))) { - *(pkt - 1) = ((i & 0x1F) << 3) + 0b000 + (addr_size - 2); - FURI_LOG_D(TAG, "VALID CRC %X: pl: %d, addr: %d", (uint16_t)crc, i, addr_size); - found = true; - break; - } - } - if(found) break; - } - } - if(found) { - 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%02X: %s (%d)", *(pkt - 1), dbuf, size); - } - int16_t i = 0; - for(; i < found_total; i++) { - if(APP->found[i].addr_size != addr_size) continue; - if(memcmp(APP->found[i].addr, pkt, addr_size) == 0) break; - } - if(i != found_total) { // found - APP->found[i].total++; - } else { - uint8_t* p = APP->log_arr + 2; - for(i = 0; i < log_arr_idx; i++, p += LOG_REC_SIZE) { - if((*(p - 2) & 0x80) && (*(p - 1) & 0b11) + 2 == addr_size && pkt != p) { - if(memcmp(p, pkt, addr_size) == 0) break; - } - } - if(i != log_arr_idx && found_total < MAX_FOUND_RECORDS) { // found -> 2 - memset(&APP->found[found_total], 0, sizeof(struct FOUND)); - memcpy(APP->found[found_total].addr, pkt, addr_size); - APP->found[found_total].addr_size = addr_size; - APP->found[found_total].total = 2; - if(found_total == 0) view_found = 0; - found_total++; - } - } - /* - if(addrs_found.addr_count == 0) { - memcpy(addrs_found.addr_P0, pkt, addr_size); - addrs_found.addr_len = addr_size; - found_total[0]++; - addrs_found.addr_count++; - } else if(addr_size == addrs_found.addr_len) { - if(!check_addr_found(pkt)) { - if(addrs_found.addr_count == 1) { - memcpy(addrs_found.addr_P1, pkt, addr_size); - found_total[1]++; - addrs_found.addr_count++; - } else if(addrs_found.addr_count == 2) { - if(memcmp(addrs_found.addr_P1, pkt, addr_size - 1) == 0) { - addrs_found.addr_P2 = pkt[addr_size - 1]; - found_total[2]++; - addrs_found.addr_count++; - } else if(memcmp(addrs_found.addr_P0, pkt, addr_size - 1) == 0) { - uint8_t tmp[5]; - memcpy(tmp, addrs_found.addr_P1, addr_size); // swap P0-P1 - memcpy(addrs_found.addr_P1, addrs_found.addr_P0, addr_size); - memcpy(addrs_found.addr_P0, tmp, addr_size); - uint32_t n = found_total[0]; - found_total[0] = found_total[1]; - found_total[1] = n; - addrs_found.addr_P2 = pkt[addr_size - 1]; - found_total[2]++; - addrs_found.addr_count++; - } - } else if(addrs_found.addr_count >= 3) { - if(memcmp(addrs_found.addr_P1, pkt, addr_size - 1) == 0) { - if(addrs_found.addr_count == 3) { - addrs_found.addr_P3 = pkt[addr_size - 1]; - found_total[3]++; - addrs_found.addr_count++; - } else if(addrs_found.addr_count == 4) { - addrs_found.addr_P4 = pkt[addr_size - 1]; - found_total[4]++; - addrs_found.addr_count++; - } else if(addrs_found.addr_count == 5) { - addrs_found.addr_P5 = pkt[addr_size - 1]; - found_total[5]++; - addrs_found.addr_count++; +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 + struct ADDRS *adr = what_to_do == 1 ? &addrs_sniff : &addrs; + if(!fsend_packet) { + uint8_t payload = NRF_Payload; + uint8_t *rec = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE; + uint8_t addr_size = (*(rec + 1) & 0b11) + 2; + bool setup_from_log = false; + if(what_to_do >= 2) { + if(log_arr_idx && (*rec & 0x80)) { + setup_from_log = true; + memcpy(addrs.addr_P0, rec + 2, addr_size); + addrs.addr_count = 1; + addrs.addr_len = addr_size; + payload = *(rec + 1) >> 3; + if(what_to_do == 2) { + uint8_t *p = APP->log_arr + 2; + int16_t i = 0; + for(i = 0; i < log_arr_idx; i++, p += LOG_REC_SIZE) { + if((*(p - 2) & 0x80) && (*(p - 1) & 0b11) + 2 == addr_size && rec + 2 != p) { + if(memcmp(p, addrs.addr_P0, addr_size - 1) == 0) { + check_add_addr(rec + 2); + if(addrs.addr_count >= 6) break; + } } } } + } + } + if(what_to_do == 1) { // SNIFF + 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 if(setup_from_log) { // Scan + 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_RF_CH, *rec & 0x7F); + nrf24_write_reg(nrf24_HANDLE, REG_FEATURE, *(rec + 2 + addr_size) >> 2 != 0x33 ? 4+1 : 1); // Enables the W_TX_PAYLOAD_NOACK command, Disable Payload with ACK, set Dynamic Payload + if(*(rec + 1) & 0b100) { // ESB + nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, 0x01); // Automatic Retransmission + nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0x3F); // Auto acknowledgement + } else { + nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, 0); // Automatic Retransmission + nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0); // Auto acknowledgement + } + } 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 ? 0x01 : 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_write_reg(nrf24_HANDLE, REG_DYNPD, NRF_DPL ? 0x3F : 0); // Enable dynamic payload reg + nrf24_write_reg(nrf24_HANDLE, REG_RF_CH, NRF_channel); + } + if(adr->addr_count == 0) return; + nrf24_write_reg(nrf24_HANDLE, RX_PW_P0, payload); + nrf24_set_maclen(nrf24_HANDLE, adr->addr_len); + nrf24_set_mac(REG_RX_ADDR_P0, adr->addr_P0, adr->addr_len); + uint8_t tmp[5] = { 0 }; + nrf24_read_reg(nrf24_HANDLE, REG_RX_ADDR_P0, tmp, adr->addr_len); + for(uint8_t i = 0; i < adr->addr_len / 2; i++) { + uint8_t tb = tmp[i]; + tmp[i] = tmp[adr->addr_len - i - 1]; + tmp[adr->addr_len - i - 1] = tb; + } + NRF_ERROR = memcmp(adr->addr_P0, tmp, adr->addr_len) != 0; + FURI_LOG_D(TAG, "Payload: %d", payload); + nrf24_write_reg(nrf24_HANDLE, RX_PW_P0, payload); + if(adr->addr_count > 1) { + nrf24_set_mac(REG_RX_ADDR_P1, adr->addr_P1, adr->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(adr->addr_count > 2) { + nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P2, &adr->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(adr->addr_count > 3) { + nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P3, &adr->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(adr->addr_count > 4) { + nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P4, &adr->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(adr->addr_count > 5) { + nrf24_write_buf_reg(nrf24_HANDLE, REG_RX_ADDR_P5, &adr->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_EN_RXADDR, erx_addr); + } + nrf24_flush_rx(nrf24_HANDLE); + nrf24_flush_tx(nrf24_HANDLE); + nrf24_set_idle(nrf24_HANDLE); +} + +void correct_NRF_Payload_sniff_min() +{ + uint8_t pld = 32 - 3 - (NRF_ESB ? 2 : 0) - NRF_CRC + (addrs_sniff.addr_len - 2); + if(NRF_Payload_sniff_min > pld) NRF_Payload_sniff_min = pld; +} + +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) { // SNIFF + correct_NRF_Payload_sniff_min(); + view_log_decode_CRC = NRF_CRC; + } else if(sniff_loaded) { // Switch from sniff to scan/view + // to do... + } + 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 +uint32_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 = 0x1021; // X^16+X^12+X^5+1 => 0x11021 & 0xFFFF = 0x1021 + } else { + crc_high = (1<<8); + polynom = 0x07; // x^8+x^2+x^1+1 => 0x107 & 0xFF = 0x07 + } + 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 +uint32_t get_shifted_crc(uint8_t *pcrc) +{ + uint32_t crc = ((*pcrc << 1) & 0xFF) | (*(pcrc+1) >> 7); + if(view_log_decode_CRC == 2) { + crc = (crc << 8) | ((*(pcrc+1) << 1) & 0xFF) | (*(pcrc+2) >> 7); + } + return crc; +} + +bool check_packet(uint8_t *pkt, uint16_t size) +{ + if(size < 3 || size > 32) return false; + uint8_t b = *pkt; + if(b == 0x55 || b == 0xAA || b == 0x00 || b == 0xFF) return false; // skip pkt when address begin with + uint32_t prevcrc = 0xFFFFFFFF; + bool found = false; + uint8_t addr_size = 3; + for(; addr_size <= 5; addr_size++) { + if(NRF_ESB){ + uint8_t _payload = *(pkt + addr_size) >> 2; + if((_payload > size - addr_size - 2 - view_log_decode_CRC && _payload != 0x33)) continue; + uint8_t *p = pkt + addr_size; + if(prevcrc == 0xFFFFFFFF) { + prevcrc = calc_crc(view_log_decode_CRC == 2 ? 0xFFFF : 0xFF, pkt, 7, 3 * 8); // crc for smallest addr + } + uint32_t crc; + if(addr_size > 3) crc = calc_crc(prevcrc, p - (addr_size - 3), 7, 8 * (addr_size - 3)); else crc = prevcrc; + if(_payload != 0x33) { // DPL + crc = calc_crc(crc, p, 7, 9 + _payload * 8); + if(crc == get_shifted_crc(p + _payload + 1)) { + *(pkt - 1) = ((_payload & 0x1F) << 3) + 0b100 + (addr_size - 2); + FURI_LOG_D(TAG, "VALID CRC %X: dpl: %d, addr: %d", (uint16_t)crc, _payload, addr_size); + found = true; + break; + } + } else { + crc = calc_crc(crc, p++, 7, 9); // PCF + if(crc == get_shifted_crc(p)) { + _payload = 0; + found = true; + } else { + for(uint8_t i = 1; i < size - addr_size - view_log_decode_CRC; i++) { + crc = calc_crc(crc, p++, 6, 8); + if(crc == get_shifted_crc(p)) { + _payload = i; + found = true; + break; + } + } + } + if(found) { + *(pkt - 1) = ((_payload & 0x1F) << 3) + 0b100 + (addr_size - 2); + FURI_LOG_D(TAG, "VALID CRC %X: pl: %d, addr: %d", (uint16_t)crc, _payload, addr_size); + break; + } + } + } else { + uint8_t *p; + if(addr_size == 3) { + prevcrc = calc_crc(view_log_decode_CRC == 2 ? 0xFFFF : 0xFF, pkt, 7, 3 * 8); // crc for smallest addr + p = pkt + addr_size; + } else { + p = pkt + addr_size - 1; + prevcrc = calc_crc(prevcrc, p++, 7, 8); + } + uint32_t crc = prevcrc; + if((view_log_decode_CRC == 1 && crc == *p) || (view_log_decode_CRC == 2 && crc == (uint32_t)((*p<<8) | *(p+1)))) { + *(pkt - 1) = ((0 & 0x1F) << 3) + 0b000 + (addr_size - 2); + FURI_LOG_D(TAG, "VALID CRC %X: pl: %d, addr: %d", (uint16_t)crc, 0, addr_size); + found = true; + break; + } + for(uint8_t i = 1; i <= size - addr_size - view_log_decode_CRC; i++) { + crc = calc_crc(crc, p++, 7, 8); + if((view_log_decode_CRC == 1 && crc == *p) || (view_log_decode_CRC == 2 && crc == (uint32_t)((*p<<8) | *(p+1)))) { + *(pkt - 1) = ((i & 0x1F) << 3) + 0b000 + (addr_size - 2); + FURI_LOG_D(TAG, "VALID CRC %X: pl: %d, addr: %d", (uint16_t)crc, i, addr_size); + found = true; + break; + } + } + if(found) break; + } + } + if(found) { + 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%02X: %s (%d)", *(pkt - 1), dbuf, size); + } + int16_t i = 0; + for(; i < found_total; i++) { + if(APP->found[i].addr_size != addr_size) continue; + if(memcmp(APP->found[i].addr, pkt, addr_size) == 0) break; + } + if(i != found_total) { // found + APP->found[i].total++; + } else { + uint8_t *p = APP->log_arr + 2; + for(i = 0; i < log_arr_idx; i++, p += LOG_REC_SIZE) { + if((*(p - 2) & 0x80) && (*(p - 1) & 0b11) + 2 == addr_size && pkt != p) { + if(memcmp(p, pkt, addr_size) == 0) break; + } + } + if(i != log_arr_idx && found_total < MAX_FOUND_RECORDS) { // found -> 2 + memset(&APP->found[found_total], 0, sizeof(struct FOUND)); + memcpy(APP->found[found_total].addr, pkt, addr_size); + APP->found[found_total].addr_size = addr_size; + APP->found[found_total].total = 2; + if(found_total == 0) view_found = 0; + found_total++; } } -*/ - } + } - return found; + return found; } 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; - /* test pkts + 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; +/* test pkts static int iii = 0; char ppp[][65] = { "54A545109411544BAAE50110A3282512A9A1152A565B22AAA48AB751A5", "C8C8C0CE7A81018007202FFFFC", @@ -858,813 +729,659 @@ bool nrf24_read_newpacket() { iii++; } else //*/ - st = nrf24_rxpacket( - nrf24_HANDLE, - ptr + 2 + (what_to_do == 1 ? addrs_sniff.addr_len - 2 : 0), - &packetsize, - what_to_do == 1 ? 32 : !NRF_DPL); - if(st & RX_DR) { - st = (st >> 1) & 7; // pipe # - if(what_to_do == 1) { // SNIFF - *ptr++ = NRF_channel | 0x80; - *ptr++ = st; // pipe # - if(addrs_sniff.addr_len > 2) { - *ptr = st == 0 ? addrs_sniff.addr_P0[2] : - st == 1 ? addrs_sniff.addr_P1[2] : - st == 2 ? addrs_sniff.addr_P2 : - st == 3 ? addrs_sniff.addr_P3 : - st == 4 ? addrs_sniff.addr_P4 : - addrs_sniff.addr_P5; - } - if(!check_packet(ptr, packetsize)) { - if(addrs_sniff.addr_len > 2) return false; // skip if mac MSB added to preamble - uint8_t shifted = 0; - uint8_t shift_max = (32 - 3 - NRF_Payload_sniff_min - NRF_CRC) * 8 - 1; - while(shifted++ < - shift_max) { // Shift packet left by one bit if minimum payload fits - uint8_t i = 0; - for(; i < packetsize - 1; i++) ptr[i] = (ptr[i] << 1) | (ptr[i + 1] >> 7); - ptr[i] <<= 1; - if(check_packet(ptr, packetsize - (shifted >> 3) - 1)) goto x_valid; - } - return false; - } - } else { - *ptr++ = NRF_channel; - *ptr++ = ((packetsize & 0x1F) << 3) | st; // payload size + pipe # - } - x_valid: - 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; + st = nrf24_rxpacket(nrf24_HANDLE, ptr + 2 + (what_to_do == 1 ? addrs_sniff.addr_len - 2 : 0), &packetsize, what_to_do == 1 ? 32 : !NRF_DPL); + if(st & RX_DR) { + st = (st >> 1) & 7; // pipe # + if(what_to_do == 1) { // SNIFF + *ptr++ = NRF_channel | 0x80; + *ptr++ = st; // pipe # + if(addrs_sniff.addr_len > 2) { + *ptr = st == 0 ? addrs_sniff.addr_P0[2] : st == 1 ? addrs_sniff.addr_P1[2] : st == 2 ? addrs_sniff.addr_P2 : st == 3 ? addrs_sniff.addr_P3 : st == 4 ? addrs_sniff.addr_P4 : addrs_sniff.addr_P5; + } + if(!check_packet(ptr, packetsize)) { + if(addrs_sniff.addr_len > 2) return false; // skip if mac MSB added to preamble + uint8_t shifted = 0; + uint8_t shift_max = (32 - 3 - NRF_Payload_sniff_min - NRF_CRC) * 8 - 1; + while(shifted++ < shift_max) { // Shift packet left by one bit if minimum payload fits + uint8_t i = 0; + for(; i < packetsize - 1; i++) ptr[i] = (ptr[i] << 1) | (ptr[i + 1] >> 7); + ptr[i] <<= 1; + if(check_packet(ptr, packetsize - (shifted >> 3) - 1)) goto x_valid; + } + return false; + } + } else { + *ptr++ = NRF_channel; + *ptr++ = ((packetsize & 0x1F) << 3) | st; // payload size + pipe # + } +x_valid: + 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; +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, 6 lines - 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, 78, 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); - if(what_to_do == 1) - snprintf(screen_buf, sizeof(screen_buf), "Min Payl: %d", NRF_Payload_sniff_min); - else if(what_to_do == 3) { - uint8_t* p = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE; - snprintf( - screen_buf, - sizeof(screen_buf), - "Payload: %d", - log_arr_idx && (*p & 0x80) ? *(p + 1) >> 3 : NRF_Payload); - } else - snprintf(screen_buf, sizeof(screen_buf), "Payload: %d", NRF_Payload); - canvas_draw_str(canvas, 78, 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 { - uint8_t* p; - if(what_to_do == 3 && log_arr_idx && - *(p = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE) & 0x80) { // +RAW - snprintf(screen_buf, sizeof(screen_buf), "Start read: "); - add_to_str_hex_bytes(screen_buf, (char*)p + 2, (*(p + 1) & 0b11) + 2); - } 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 == 0 ? "View" : - "Read", - 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; - uint32_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 == (uint32_t)((*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; - uint32_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 == (uint32_t)((*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 = page + i + 1; - if(x > 99) { - snprintf(screen_buf, 16, "%d", x); - canvas_draw_str(canvas, 1, y, screen_buf + 1); - canvas_draw_frame(canvas, 0, y - 2, 1, 2); - x = 2; - } else { - x = snprintf(screen_buf, 16, "%d", x); - 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(view_found >= 0) { - snprintf(screen_buf, 50, "Found > 1: %d", found_total); - canvas_draw_str(canvas, 0, 1 * 7, screen_buf); - int16_t idx = view_found * 7; - for(uint8_t i = 0; i < 7; i++, idx++) { - if(idx >= found_total) break; - snprintf(screen_buf, 16, "%d. ", idx + 1); - add_to_str_hex_bytes( - screen_buf, (char*)APP->found[idx].addr, APP->found[idx].addr_size); - if(APP->found[idx].addr_size == 3) - strcat(screen_buf, " "); - else if(APP->found[idx].addr_size == 4) - strcat(screen_buf, " "); - snprintf(screen_buf + strlen(screen_buf), 16, " - %d", APP->found[idx].total); - canvas_draw_str(canvas, 0, (2 + i) * 7, screen_buf); - } - } else { - struct ADDRS* a; - if(what_to_do == 1) { - a = &addrs_sniff; - canvas_draw_str(canvas, 0, 1 * 7, "Sniff prefix:"); - } else { - a = &addrs; - canvas_draw_str(canvas, 0, 1 * 7, "Addresses:"); - } - if(a->addr_count > 0) { - snprintf(screen_buf, sizeof(screen_buf), "P0: "); - add_to_str_hex_bytes(screen_buf, (char*)a->addr_P0, a->addr_len); - canvas_draw_str(canvas, 0, 2 * 7, screen_buf); - } - if(a->addr_count > 1) { - snprintf(screen_buf, sizeof(screen_buf), "P1: "); - add_to_str_hex_bytes(screen_buf, (char*)a->addr_P1, a->addr_len); - canvas_draw_str(canvas, 0, 3 * 7, screen_buf); - } - if(a->addr_count > 2) { - canvas_draw_str(canvas, 0, 4 * 7, "P2: "); - snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P2); - canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 4 * 7, screen_buf); - } - if(a->addr_count > 3) { - canvas_draw_str(canvas, 0, 5 * 7, "P3: "); - snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P3); - canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 5 * 7, screen_buf); - } - if(a->addr_count > 4) { - canvas_draw_str(canvas, 0, 6 * 7, "P4: "); - snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P4); - canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 6 * 7, screen_buf); - } - if(a->addr_count > 5) { - canvas_draw_str(canvas, 0, 7 * 7, "P5: "); - snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P5); - canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 7 * 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 L: %d", *ptr & 0x7F, pktinfo >> 3); - if(*ptr & 0x80) { - strcat(screen_buf, " RAW"); - if(pktinfo & 0b100) { - snprintf( - screen_buf + strlen(screen_buf), - 16, - " ESB %s", - *(ptr + 2 + (pktinfo & 0b11) + 2) >> 2 != 0x33 ? "DPL" : ""); - } - } - canvas_draw_str(canvas, 0, 8 * 7, screen_buf); - } - screen_buf[0] = 'v'; - strcpy(screen_buf + 1, VERSION); - canvas_draw_str(canvas, 105, 7, screen_buf); - if(view_log_decode_PCF || view_log_decode_CRC) { - strcpy(screen_buf, "Decode: "); - if(view_log_decode_PCF) strcat(screen_buf, "ESB "); - 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); -} + 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, 6 lines + 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, 78, 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); + if(what_to_do == 1) snprintf(screen_buf, sizeof(screen_buf), "Min Payl: %d", NRF_Payload_sniff_min); + else if(what_to_do >= 2) { + uint8_t *p = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE; + snprintf(screen_buf, sizeof(screen_buf), "Payload: %d", log_arr_idx && (*p & 0x80) ? *(p + 1) >> 3 : NRF_Payload); + } else snprintf(screen_buf, sizeof(screen_buf), "Payload: %d", NRF_Payload); + canvas_draw_str(canvas, 78, 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 { + uint8_t *p = APP->log_arr + view_log_arr_idx * LOG_REC_SIZE; + if(log_arr_idx && (*p & 0x80)) { // +RAW + snprintf(screen_buf, sizeof(screen_buf), "Start read: "); + add_to_str_hex_bytes(screen_buf, (char*)p + 2, (*(p + 1) & 0b11) + 2); + if(what_to_do == 3) strcpy(screen_buf + strlen(screen_buf) - 2, "* "); + } 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 == 0 ? "View" : "Read", 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; + uint32_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 == (uint32_t)((*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; + uint32_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 == (uint32_t)((*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 = page + i + 1; + if(x > 99) { + snprintf(screen_buf, 16, "%d", x); + canvas_draw_str(canvas, 1, y, screen_buf + 1); + canvas_draw_frame(canvas, 0, y - 2, 1, 2); + x = 2; + } else { + x = snprintf(screen_buf, 16, "%d", x); + 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(view_found >= 0) { + snprintf(screen_buf, 50, "Found > 1: %d", found_total); + canvas_draw_str(canvas, 0, 1 * 7, screen_buf); + int16_t idx = view_found * 7; + for(uint8_t i = 0; i < 7; i++, idx++) { + if(idx >= found_total) break; + snprintf(screen_buf, 16, "%d. ", idx + 1); + add_to_str_hex_bytes(screen_buf, (char*)APP->found[idx].addr, APP->found[idx].addr_size); + if(APP->found[idx].addr_size == 3) strcat(screen_buf, " "); else if(APP->found[idx].addr_size == 4) strcat(screen_buf, " "); + snprintf(screen_buf + strlen(screen_buf), 16, " - %d", APP->found[idx].total); + canvas_draw_str(canvas, 0, (2 + i) * 7, screen_buf); + } + } else { + struct ADDRS *a; + if(what_to_do == 1) { + a = &addrs_sniff; + canvas_draw_str(canvas, 0, 1 * 7, "Sniff prefix:"); + } else { + a = &addrs; + canvas_draw_str(canvas, 0, 1 * 7, "Addresses:"); + } + if(a->addr_count > 0) { + snprintf(screen_buf, sizeof(screen_buf), "P0: "); + add_to_str_hex_bytes(screen_buf, (char*)a->addr_P0, a->addr_len); + canvas_draw_str(canvas, 0, 2 * 7, screen_buf); + } + if(a->addr_count > 1) { + snprintf(screen_buf, sizeof(screen_buf), "P1: "); + add_to_str_hex_bytes(screen_buf, (char*)a->addr_P1, a->addr_len); + canvas_draw_str(canvas, 0, 3 * 7, screen_buf); + } + if(a->addr_count > 2) { + canvas_draw_str(canvas, 0, 4 * 7, "P2: "); + snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P2); + canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 4 * 7, screen_buf); + } + if(a->addr_count > 3) { + canvas_draw_str(canvas, 0, 5 * 7, "P3: "); + snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P3); + canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 5 * 7, screen_buf); + } + if(a->addr_count > 4) { + canvas_draw_str(canvas, 0, 6 * 7, "P4: "); + snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P4); + canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 6 * 7, screen_buf); + } + if(a->addr_count > 5) { + canvas_draw_str(canvas, 0, 7 * 7, "P5: "); + snprintf(screen_buf, sizeof(screen_buf), "%02X", a->addr_P5); + canvas_draw_str(canvas, (4 + (a->addr_len - 1) * 2) * 5, 7 * 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 L: %d", *ptr & 0x7F, pktinfo >> 3); + if(*ptr & 0x80) { + strcat(screen_buf, " RAW"); + if(pktinfo & 0b100) { + snprintf(screen_buf + strlen(screen_buf), 16, " ESB %s", *(ptr + 2 + (pktinfo & 0b11) + 2) >> 2 != 0x33 ? "DPL" : ""); + } + } + canvas_draw_str(canvas, 0, 8 * 7, screen_buf); + } + screen_buf[0] = 'v'; + strcpy(screen_buf + 1, VERSION); + canvas_draw_str(canvas, 105, 7, screen_buf); + if(view_log_decode_PCF || view_log_decode_CRC) { + strcpy(screen_buf, "Decode: "); + if(view_log_decode_PCF) strcat(screen_buf, "ESB "); + 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; - } - 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(); - APP->found = malloc(sizeof(struct FOUND) * MAX_FOUND_RECORDS); - if(APP->found == NULL) { - FURI_LOG_E(TAG, "Not enouch memory: %d", sizeof(struct FOUND) * MAX_FOUND_RECORDS); - strcpy(addr_file_name, "MEMORY LOW!!"); - } + 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; + } + 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(); + APP->found = malloc(sizeof(struct FOUND) * MAX_FOUND_RECORDS); + if(APP->found == NULL) { + FURI_LOG_E(TAG, "Not enouch memory: %d", sizeof(struct FOUND) * MAX_FOUND_RECORDS); + strcpy(addr_file_name, "MEMORY LOW!!"); + } - memset((uint8_t*)&addrs, 0, sizeof(addrs)); - memset((uint8_t*)&addrs_sniff, 0, sizeof(addrs_sniff)); - nrf24_init(); + memset((uint8_t*)&addrs, 0, sizeof(addrs)); + memset((uint8_t*)&addrs_sniff, 0, sizeof(addrs_sniff)); + 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); + // 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] = 0x55; - addrs.addr_len = 2; - addrs.addr_count = 1; - view_log_decode_CRC = NRF_CRC = 2; - NRF_Payload_sniff_min = 0; // Min - } - } - file_stream_close(file_stream); - stream_free(file_stream); - furi_string_free(path); + // 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] = 0x55; + addrs.addr_len = 2; + addrs.addr_count = 1; + view_log_decode_CRC = NRF_CRC = 2; + NRF_Payload_sniff_min = 0; // Min + } + } + file_stream_close(file_stream); + stream_free(file_stream); + furi_string_free(path); - 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); + 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; - } else if(what_doing == 2) { - if(view_found > -1) view_found--; - } - } - 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; - } else if(what_doing == 2) { - if(view_found < found_total / 7) view_found++; - } - } - 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: - if(what_to_do == 1) { // SNIFF - NRF_Payload_sniff_min -= - event.input.type == InputTypeRepeat ? 10 : 1; - correct_NRF_Payload_sniff_min(); - } else { - NRF_Payload -= event.input.type == InputTypeRepeat ? 10 : 1; - if(NRF_Payload > 32) NRF_Payload = 0; - } - 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 > 3) what_to_do = 3; - 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: - if(what_to_do == 1) { // SNIFF - NRF_Payload_sniff_min += - event.input.type == InputTypeRepeat ? 10 : 1; - correct_NRF_Payload_sniff_min(); - } else { - NRF_Payload += event.input.type == InputTypeRepeat ? 10 : 1; - if(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 > 3) 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(what_to_do == 1) { - if(NRF_ESB) - NRF_DPL = NRF_ESB = 0; - else - NRF_ESB = 1; - } else { - if(NRF_ESB) { - if(NRF_DPL) - NRF_DPL = NRF_ESB = 0; - else - NRF_DPL = 1; - } else - NRF_ESB = 1; - } - 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 == 3 && log_arr_idx && - *(APP->log_arr + view_log_arr_idx * LOG_REC_SIZE) & - 0x80)) || - 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; - break; - } - } else if(what_doing == 1) { - what_doing = 2; - } else if(what_doing == 2) { - what_doing = 1; - } - } else if(event.input.type == InputTypeLong) { - if(what_doing == 0) { - if(menu_selected == Menu_enter_channel) { - NRF_AA_OFF ^= 1; - } 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) { - nrf24_send_packet(); - } - } - 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(); - } - } + 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; + } else if(what_doing == 2) { + if(view_found > -1) view_found--; + } + } + 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; + } else if(what_doing == 2) { + if(view_found < found_total / 7) view_found++; + } + } + 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: + if(what_to_do == 1) { // SNIFF + NRF_Payload_sniff_min -= event.input.type == InputTypeRepeat ? 10 : 1; + correct_NRF_Payload_sniff_min(); + } else { + NRF_Payload -= event.input.type == InputTypeRepeat ? 10 : 1; + if(NRF_Payload > 32) NRF_Payload = 0; + } + 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 > 3) what_to_do = 3; + 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: + if(what_to_do == 1) { // SNIFF + NRF_Payload_sniff_min += event.input.type == InputTypeRepeat ? 10 : 1; + correct_NRF_Payload_sniff_min(); + } else { + NRF_Payload += event.input.type == InputTypeRepeat ? 10 : 1; + if(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 > 3) 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(what_to_do == 1) { + if(NRF_ESB) NRF_DPL = NRF_ESB = 0; else NRF_ESB = 1; + } else { + if(NRF_ESB) { + if(NRF_DPL) NRF_DPL = NRF_ESB = 0; else NRF_DPL = 1; + } else NRF_ESB = 1; + } + 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 >= 2 && log_arr_idx && *(APP->log_arr + view_log_arr_idx * LOG_REC_SIZE) & 0x80)) || 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; + break; + } + } else if(what_doing == 1) { + what_doing = 2; + } else if(what_doing == 2) { + what_doing = 1; + } + } else if(event.input.type == InputTypeLong) { + if(what_doing == 0) { + if(menu_selected == Menu_enter_channel) { + NRF_AA_OFF ^= 1; + } 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) { + nrf24_send_packet(); + } + } + 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_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); - if(APP->found) free(APP->found); - free(APP); - return 0; -} \ No newline at end of file + 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); + if(APP->found) free(APP->found); + free(APP); + return 0; +} diff --git a/assets/resources/apps_data/nrf24scan/sniff2.txt b/assets/resources/apps_data/nrf24scan/sniff2.txt new file mode 100644 index 000000000..fa8c5ba9f --- /dev/null +++ b/assets/resources/apps_data/nrf24scan/sniff2.txt @@ -0,0 +1,5 @@ +SNIFF +ESB: 1 +CRC: 2 +P0: 00AA +P1: 0055 diff --git a/assets/resources/apps_data/nrf24scan/sniff3.txt b/assets/resources/apps_data/nrf24scan/sniff3.txt new file mode 100644 index 000000000..675852f2d --- /dev/null +++ b/assets/resources/apps_data/nrf24scan/sniff3.txt @@ -0,0 +1,6 @@ +SNIFF +ESB: 1 +CRC: 2 +P0: FFAA +P1: 0055 +P2: AA