nrf24batch.c 47 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444
  1. //
  2. // Written by vad7, 10.01.2023. vad7@yahoo.com
  3. //
  4. #include "nrf24batch.h"
  5. #include <furi.h>
  6. #include <furi_hal.h>
  7. #include <gui/gui.h>
  8. #include <dialogs/dialogs.h>
  9. #include <input/input.h>
  10. #include <stdlib.h>
  11. #include <dolphin/dolphin.h>
  12. #include <nrf24.h>
  13. #include <u8g2.h>
  14. #define TAG "nrf24batch"
  15. #define VERSION "1.2"
  16. #define SCAN_APP_PATH_FOLDER "/ext/nrf24batch"
  17. #define LOG_FILEEXT ".txt"
  18. #define NRF_READ_TIMEOUT 300UL // ms
  19. #define WORK_PERIOD 2 // ms, Timer period
  20. #define MAX_CHANNEL 125
  21. #define FONT_5x7_SCREEN_WIDTH 25
  22. const char SettingsFld_Info[] = "Info:";
  23. const char SettingsFld_Ch[] = "Ch:";
  24. const char SettingsFld_Rate[] = "Rate:";
  25. const char SettingsFld_DPL[] = "DPL:";
  26. const char SettingsFld_CRC[] = "CRC:";
  27. const char SettingsFld_RETR[] = "RETR:";
  28. const char SettingsFld_Address[] = "Address:";
  29. const char SettingsFld_Resend[] = "Resend:";
  30. const char SettingsFld_Delay[] = "Delay_ms:";
  31. const char SettingsFld_WriteStart[] = "Write start:";
  32. const char SettingsFld_Payload[] = "Payload struct:";
  33. const char SettingsFld_ReadDefault[] = "R default:";
  34. const char SettingsFld_WriteDefault[] = "W default:";
  35. const char SettingsFld_Read[] = "R:";
  36. const char SettingsFld_Write[] = "W:";
  37. const char SettingsFld_ReadBatch[] = "RBatch:";
  38. const char SettingsFld_WriteBatch[] = "WBatch:";
  39. const char AskQuestion_Save[] = "SAVE BATCH?";
  40. #define Settings_i 'i'
  41. #define Settings_n 'n'
  42. #define VAR_EMPTY ((int32_t)0x80000000)
  43. nRF24Batch* APP;
  44. uint8_t what_doing = 0; // 0 - setup, 1 - cmd list, 2 - view send cmd
  45. enum {
  46. rwt_read_batch = 0,
  47. rwt_read_cmd,
  48. rwt_write_batch
  49. };
  50. uint8_t rw_type = rwt_read_batch; // What to do: rwt_*
  51. enum {
  52. sst_none = 0,
  53. sst_sending,
  54. sst_receiving,
  55. sst_ok,
  56. sst_error,
  57. sst_timeout
  58. };
  59. uint8_t send_status = sst_none;// sst_*
  60. bool cmd_array = false;
  61. uint8_t cmd_array_idx;
  62. uint8_t cmd_array_cnt = 0;
  63. bool cmd_array_hex;
  64. uint8_t save_settings = 0;
  65. uint16_t view_cmd[3] = {0, 0, 0}; // ReadBatch, Read, WriteBatch
  66. uint8_t view_x = 0;
  67. char screen_buf[64];
  68. char Info[FONT_5x7_SCREEN_WIDTH] = "";
  69. char file_name[FONT_5x7_SCREEN_WIDTH];
  70. char ERR_STR[FONT_5x7_SCREEN_WIDTH];
  71. uint8_t ERR = 0;
  72. uint8_t NRF_rate; // 0 - 250Kbps, 1 - 1Mbps, 2 - 2Mbps
  73. uint8_t NRF_channel;// 0..125
  74. uint8_t NRF_DPL; // 1 - Dynamic Payload Length
  75. uint8_t NRF_CRC; // 1 - No, 1 - CRC 1byte, 2 - CRC 2byte
  76. uint8_t NRF_RETR = ((0b0011<<4) | 0b1111); // Automatic Retransmission, ARD, ARC
  77. uint8_t NRF_Payload;// Payload len in bytes, 0..32
  78. bool NRF_ERROR = 0;
  79. bool NRF_INITED = false;
  80. uint8_t NRF_last_packet_send_st = 0;
  81. uint8_t NRF_resend = 1; // number of transaction attempts
  82. uint8_t NRF_repeat = 0; // count number of repeated requests (until < NRF_resend)
  83. uint32_t NRF_time;
  84. uint32_t delay_between_pkt = 10;// ms
  85. uint8_t addr[5]; // nRF24 address, MSB first
  86. uint8_t addr_len; // 2..5
  87. uint8_t payload[32];
  88. uint8_t payload_receive[32];
  89. uint8_t payload_struct[32]; // sizeof(1..4) in bytes of each field, example: 2,1,1
  90. uint8_t payload_fields = 0;
  91. uint8_t payload_size = 0; // bytes
  92. uint16_t view_Batch = 0; // view pos in Batch or inside WriteBatch (Log[view_Batch])
  93. uint16_t view_WriteBatch = 0; // view pos of WriteBatch list
  94. uint8_t setup_cursor = 0; // cursor position on Setup scr
  95. uint8_t Edit = 0;
  96. char *Edit_pos;
  97. char *Edit_start;
  98. bool Edit_hex; // 0 - decimal, 1 - hex
  99. bool Edited = false; // list of cmds edited
  100. Stream* file_stream = NULL;
  101. FuriString *ReadDefault = NULL;
  102. FuriString *WriteDefault = NULL;
  103. FuriString *WriteStart = NULL;
  104. FuriString *Constants = NULL; // text of STR=x
  105. FuriString **Read_cmd = NULL; // Names of read cmd
  106. uint16_t Read_cmd_Total = 0;
  107. FuriString **Log = NULL; // Strings: var=n
  108. uint16_t Log_Total = 0;
  109. FuriString **ReadBatch_cmd = NULL; // Names of read batch cmd
  110. uint16_t ReadBatch_cmd_Total = 0;
  111. char *ReadBatch_cmd_curr = NULL; // =0xFFFFFFFF - finish
  112. FuriString **WriteBatch_cmd = NULL; // Names of write batch cmd
  113. uint16_t WriteBatch_cmd_Total = 0;
  114. uint16_t WriteBatch_cmd_curr = 0; // == _Total - finish
  115. enum {
  116. ask_write_batch = 1,
  117. ask_save_batch,
  118. ask_skip_cmd,
  119. ask_return,
  120. ask_exit
  121. };
  122. uint8_t ask_question = 0; // 1 - Ask now - ask_*
  123. uint8_t ask_question_answer = 0;// 0 - no, 1 - yes
  124. static bool ask_fill_screen_buf(void)
  125. {
  126. if(ask_question == ask_write_batch) strcpy(screen_buf, "RUN WRITE BATCH?");
  127. else if(ask_question == ask_save_batch) strcpy(screen_buf, "SAVE AS WRITE BATCH?");
  128. else if(ask_question == ask_skip_cmd) strcpy(screen_buf, "SKIP CMD?");
  129. else if(ask_question == ask_return) strcpy(screen_buf, "RETURN?");
  130. else if(ask_question == ask_exit) strcpy(screen_buf, "EXIT?");
  131. else return false;
  132. strcat(screen_buf, ask_question_answer ? " YES" : " NO");
  133. return true;
  134. }
  135. //#define MIN(a, b) ((a<b)?a:b)
  136. static uint8_t GetHexVal(char hex) {
  137. return (uint8_t)hex - ((uint8_t)hex < 58 ? 48 : ((uint8_t)hex < 97 ? 55 : 87));
  138. }
  139. static bool is_digit(char *ptr, bool hex)
  140. {
  141. char c = *ptr;
  142. if(c >= '0' && c <= '9') return true;
  143. if(hex) {
  144. c &= ~0x20;
  145. if(c >= 'A' && c <= 'F') return true;
  146. }
  147. return false;
  148. }
  149. // Return num bytes in array
  150. static uint8_t ConvertHexToArray(char * hex, uint8_t * array, uint8_t maxlen) {
  151. uint8_t len = 0;
  152. while(maxlen) {
  153. uint8_t ch = *hex++;
  154. if(ch < ' ') break;
  155. if(ch < '0') continue;
  156. *array++ = (GetHexVal(ch) << 4) + GetHexVal(*hex++);
  157. len++;
  158. maxlen--;
  159. }
  160. return len;
  161. }
  162. int32_t str_to_int(char *p)
  163. {
  164. if(*(p+1) == 'x') { // hex
  165. return strtol(p + 2, NULL, 16);
  166. } else return strtol(p, NULL, 10);
  167. }
  168. void str_rtrim(char *p)
  169. {
  170. char *delim_col = strchr(p, '\r');
  171. if(delim_col) *delim_col = '\0';
  172. else {
  173. delim_col = strchr(p, '\n');
  174. if(delim_col) *delim_col = '\0';
  175. }
  176. }
  177. static void add_to_str_hex_bytes(char *out, uint8_t *arr, int bytes)
  178. {
  179. if(bytes <= 0) return;
  180. out += strlen(out);
  181. do {
  182. snprintf(out, 3, "%02X", *arr++);
  183. out += 2;
  184. } while(--bytes);
  185. }
  186. void free_Log()
  187. {
  188. if(Log_Total) {
  189. for(uint16_t i = 0; i < Log_Total; i++) if(Log[i]) furi_string_free(Log[i]);
  190. Log_Total = 0;
  191. }
  192. if(Log) {
  193. free(Log);
  194. Log = NULL;
  195. }
  196. }
  197. void free_store(void)
  198. {
  199. if(Constants) {
  200. furi_string_free(Constants);
  201. Constants = NULL;
  202. }
  203. if(ReadDefault) {
  204. furi_string_free(ReadDefault);
  205. ReadDefault = NULL;
  206. }
  207. if(WriteDefault) {
  208. furi_string_free(WriteDefault);
  209. WriteDefault = NULL;
  210. }
  211. if(WriteStart) {
  212. furi_string_free(WriteStart);
  213. WriteDefault = NULL;
  214. }
  215. if(Read_cmd_Total) {
  216. for(uint16_t i = 0; i < Read_cmd_Total; i++) furi_string_free(Read_cmd[i]);
  217. Read_cmd_Total = 0;
  218. }
  219. if(Read_cmd) {
  220. free(Read_cmd);
  221. Read_cmd = NULL;
  222. }
  223. if(ReadBatch_cmd_Total) {
  224. for(uint16_t i = 0; i < ReadBatch_cmd_Total; i++) furi_string_free(ReadBatch_cmd[i]);
  225. ReadBatch_cmd_Total = 0;
  226. }
  227. if(ReadBatch_cmd) {
  228. free(ReadBatch_cmd);
  229. ReadBatch_cmd = NULL;
  230. }
  231. if(WriteBatch_cmd_Total) {
  232. for(uint16_t i = 0; i < WriteBatch_cmd_Total; i++) furi_string_free(WriteBatch_cmd[i]);
  233. WriteBatch_cmd_Total = 0;
  234. }
  235. if(WriteBatch_cmd) {
  236. free(WriteBatch_cmd);
  237. WriteBatch_cmd = NULL;
  238. }
  239. free_Log();
  240. }
  241. static bool select_settings_file() {
  242. DialogsApp* dialogs = furi_record_open("dialogs");
  243. bool result = false;
  244. FuriString* path;
  245. path = furi_string_alloc();
  246. furi_string_set(path, SCAN_APP_PATH_FOLDER);
  247. DialogsFileBrowserOptions browser_options;
  248. dialog_file_browser_set_basic_options(&browser_options, ".txt", NULL);
  249. browser_options.hide_ext = false;
  250. bool ret = dialog_file_browser_show(dialogs, path, path, &browser_options);
  251. furi_record_close("dialogs");
  252. if(ret) {
  253. if(!file_stream_open(file_stream, furi_string_get_cstr(path), FSAM_READ_WRITE, FSOM_OPEN_EXISTING)) {
  254. FURI_LOG_D(TAG, "Cannot open file \"%s\"", furi_string_get_cstr(path));
  255. file_stream_close(file_stream);
  256. } else {
  257. FURI_LOG_D(TAG, "Open file \"%s\"", furi_string_get_cstr(path));
  258. strncpy(file_name, furi_string_get_cstr(path) + sizeof(SCAN_APP_PATH_FOLDER), sizeof(file_name));
  259. result = true;
  260. }
  261. }
  262. furi_string_free(path);
  263. return result;
  264. }
  265. static void prepare_nrf24(void)
  266. {
  267. if(!NRF_INITED) {
  268. nrf24_write_reg(nrf24_HANDLE, REG_RF_CH, NRF_channel);
  269. nrf24_write_reg(nrf24_HANDLE, REG_RF_SETUP, (NRF_rate == 0 ? 0b00100000 : NRF_rate == 1 ? 0 : 0b00001000) | 0b111); // +TX high power
  270. nrf24_write_reg(nrf24_HANDLE, REG_CONFIG, 0x70 | ((NRF_CRC == 1 ? 0b1000 : NRF_CRC == 2 ? 0b1100 : 0))); // Mask all interrupts
  271. nrf24_write_reg(nrf24_HANDLE, REG_SETUP_RETR, NRF_RETR); // Automatic Retransmission, ARD<<4 + ARC
  272. nrf24_write_reg(nrf24_HANDLE, REG_EN_AA, 0x01); // Auto acknowledgement
  273. nrf24_write_reg(nrf24_HANDLE, REG_FEATURE, NRF24_EN_DYN_ACK | (NRF_DPL ? 4 : 0)); // Enables the W_TX_PAYLOAD_NOACK command, Disable Payload with ACK, set Dynamic Payload
  274. nrf24_write_reg(nrf24_HANDLE, REG_DYNPD, NRF_DPL ? 0x3F : 0); // Enable dynamic payload reg
  275. nrf24_write_reg(nrf24_HANDLE, RX_PW_P0, payload_size);
  276. nrf24_set_maclen(nrf24_HANDLE, addr_len);
  277. nrf24_set_mac(REG_RX_ADDR_P0, addr, addr_len);
  278. uint8_t tmp[5] = { 0 };
  279. nrf24_read_reg(nrf24_HANDLE, REG_RX_ADDR_P0, tmp, addr_len);
  280. for(uint8_t i = 0; i < addr_len / 2; i++) {
  281. uint8_t tb = tmp[i];
  282. tmp[i] = tmp[addr_len - i - 1];
  283. tmp[addr_len - i - 1] = tb;
  284. }
  285. NRF_ERROR = memcmp(addr, tmp, addr_len) != 0;
  286. nrf24_set_mac(REG_TX_ADDR, addr, addr_len);
  287. nrf24_write_reg(nrf24_HANDLE, REG_EN_RXADDR, 1);
  288. //nrf24_set_idle(nrf24_HANDLE);
  289. NRF_INITED = true;
  290. }
  291. nrf24_flush_tx(nrf24_HANDLE);
  292. nrf24_flush_rx(nrf24_HANDLE);
  293. nrf24_write_reg(nrf24_HANDLE, REG_STATUS, MAX_RT | RX_DR | TX_DS);
  294. furi_hal_gpio_write(nrf24_CE_PIN, false);
  295. }
  296. // true - ok
  297. uint8_t nrf24_send_packet()
  298. {
  299. if(furi_log_get_level() == FuriLogLevelDebug) {
  300. char buf[65]; buf[0] = 0; add_to_str_hex_bytes(buf, payload, payload_size); FURI_LOG_D(TAG, "SEND: %s", buf);
  301. }
  302. //nrf24_flush_tx(nrf24_HANDLE);
  303. //nrf24_write_reg(nrf24_HANDLE, REG_STATUS, RX_DR | TX_DS | MAX_RT);
  304. NRF_last_packet_send_st = nrf24_txpacket(nrf24_HANDLE, payload, payload_size, true); // ACK
  305. if(NRF_last_packet_send_st) {
  306. if((rw_type == rwt_read_cmd || rw_type == rwt_read_batch) && send_status == sst_sending) { // Read
  307. nrf24_set_rx_mode(nrf24_HANDLE);
  308. send_status = sst_receiving; // receiving
  309. }
  310. } else notification_message(APP->notification, &sequence_blink_red_100);
  311. NRF_time = furi_get_tick();
  312. FURI_LOG_D(TAG, "Send packet: %d%s", NRF_last_packet_send_st, send_status == sst_receiving ? ", Receiving" : "");
  313. return NRF_last_packet_send_st;
  314. }
  315. uint8_t nrf24_resend_read_packet()
  316. {
  317. if(Log_Total && !cmd_array) {
  318. FuriString *str = Log[Log_Total - 1];
  319. char *p = strstr(furi_string_get_cstr(str), ": ");
  320. if(p) {
  321. if(strncmp(p + 2, "0x", 2) == 0) p += 2;
  322. furi_string_left(str, p - furi_string_get_cstr(str) + 2);
  323. }
  324. }
  325. return nrf24_send_packet();
  326. }
  327. // true - new packet
  328. bool nrf24_read_newpacket() {
  329. bool found = false;
  330. uint8_t packetsize;
  331. uint8_t st = nrf24_rxpacket(nrf24_HANDLE, payload_receive, &packetsize, NRF_DPL ? 0 : payload_size);
  332. if(st & RX_DR) {
  333. NRF_time = furi_get_tick();
  334. if(furi_log_get_level() == FuriLogLevelDebug) {
  335. char buf[65]; buf[0] = 0; add_to_str_hex_bytes(buf, payload_receive, packetsize); FURI_LOG_D(TAG, "READ(%X): %s", st, buf);
  336. }
  337. if(Log_Total) {
  338. FuriString *str = Log[Log_Total - 1];
  339. uint8_t size = 1;
  340. char *p = strchr((char*)furi_string_get_cstr(str), '*');
  341. if(p) {
  342. p++;
  343. if(*p == '=') size = 0; // string
  344. else {
  345. size = *p - '0';
  346. if(size > 4) size = 0;
  347. }
  348. }
  349. int32_t var;
  350. if(size <= 1) var = *payload_receive;
  351. else if(size == 2) var = *(int16_t*)payload_receive;
  352. else if(size == 3) var = (*(uint32_t*)payload_receive) & 0xFFFFFF;
  353. else var = *(int32_t*)payload_receive;
  354. //FURI_LOG_D(TAG, "VAR(%d): %ld", size, var);
  355. if(size == 0) furi_string_cat_printf(str, "%c", (char)var);
  356. else {
  357. char hex[9];
  358. snprintf(hex, sizeof(hex), "%lX", var);
  359. if((cmd_array && cmd_array_hex) || furi_string_end_with_str(str, "0x")) furi_string_cat_str(str, hex);
  360. else {
  361. if(var >= 0 && var <= 9) furi_string_cat_printf(str, "%ld", var);
  362. else furi_string_cat_printf(str, "%ld (%s)", var, hex + (var < 0 ? 8 - size * 2 : 0));
  363. }
  364. }
  365. if(cmd_array) {
  366. if(--cmd_array_cnt) {
  367. furi_string_cat_str(str, ",");
  368. if(cmd_array_hex) furi_string_cat_str(str, "0x");
  369. payload[cmd_array_idx]++; // next array element
  370. NRF_repeat = 0;
  371. send_status = sst_sending; // Will be send after delay_between_pkt
  372. } else send_status = sst_ok;
  373. } else {
  374. if(size == 0) { // string, until '\0'
  375. if(var == 0) send_status = sst_ok;
  376. } else send_status = sst_ok;
  377. }
  378. }
  379. //notification_message(APP->notification, &sequence_blink_white_100);
  380. found = true;
  381. }
  382. return found;
  383. }
  384. // Search in constatnt pull (Const1=n; Const2=n;...)
  385. // VAR_EMPTY - not found
  386. int32_t subs_constant(char *p, uint8_t len)
  387. {
  388. char *c = (char*)furi_string_get_cstr(Constants);
  389. while((c = strchr(c, *p))) {
  390. if(strncmp(c, p, len) != 0) {
  391. c++;
  392. continue;
  393. }
  394. if(c == (char*)furi_string_get_cstr(Constants) || *(c-1) == ';' || *(c-1) <= ' ') {
  395. c += len;
  396. if(*c == '=') {
  397. c++;
  398. return str_to_int(c);
  399. }
  400. } else c += len;
  401. }
  402. return VAR_EMPTY;
  403. }
  404. // fill payload with default = p
  405. // if var_n = VAR_EMPTY - skip filling var_*
  406. bool fill_payload(char *p, uint8_t *idx_i, int32_t var_n)
  407. {
  408. if(idx_i) *idx_i = 255;
  409. uint8_t fld = 0; // field #
  410. uint8_t idx = 0; // byte index
  411. do {
  412. int32_t b = 0;
  413. char *end = strchr(p, ',');
  414. if(*p >= '0' && *p <= '9') { // Number found
  415. b = str_to_int(p);
  416. } else if(*p == 'i' && *(p + 1) == ':') { // 'i:' array index
  417. b = str_to_int(p + 2);
  418. if(idx_i) *idx_i = idx;
  419. } else if(*p == 'n' && *(p + 1) < '0') { // var_n
  420. if(var_n != VAR_EMPTY) b = var_n;
  421. } else if(*p >= 'A') { // constant found
  422. b = subs_constant(p, end ? (uint8_t)(end - p) : strlen(p));
  423. if(b == VAR_EMPTY) {
  424. ERR = 1;
  425. memset(ERR_STR, 0, sizeof(ERR_STR));
  426. strcpy(ERR_STR, "No ");
  427. strncpy(ERR_STR + strlen(ERR_STR), p, sizeof(ERR_STR) - 4);
  428. FURI_LOG_D(TAG, "Constant not found: %s", p);
  429. return false;
  430. }
  431. } else if(end == p) {
  432. idx += payload_struct[fld];
  433. } else if(*p == '#') { // value in Hexadecimal, end string
  434. break;
  435. } else {
  436. ERR = 2;
  437. strcpy(ERR_STR, "char: ");
  438. uint8_t l = strlen(ERR_STR);
  439. ERR_STR[l] = *p;
  440. ERR_STR[l+1] = '\0';
  441. FURI_LOG_D(TAG, "Wrong format char(%c)", *p);
  442. return false;
  443. }
  444. if(end != p) {
  445. payload[idx++] = b;
  446. if(payload_struct[fld] > 1) payload[idx++] = b >> 8;
  447. if(payload_struct[fld] > 2) payload[idx++] = b >> 16;
  448. if(payload_struct[fld] > 3) payload[idx++] = b >> 24;
  449. }
  450. if(++fld == payload_fields || idx >= sizeof(payload) || end == NULL) break;
  451. p = end + 1;
  452. } while(1);
  453. return true;
  454. }
  455. // Cmd: "name=payload"
  456. bool Run_Read_cmd(FuriString *cmd)
  457. {
  458. char *p = (char*)furi_string_get_cstr(cmd);
  459. p = strchr(p, '=');
  460. if(p == NULL) return false;
  461. if(Log == NULL) Log = malloc(sizeof(Log));
  462. else Log = realloc(Log, sizeof(Log) * (Log_Total + 1));
  463. if(Log == NULL) {
  464. ERR = 3;
  465. strcpy(ERR_STR, "Memory low");
  466. FURI_LOG_D(TAG, ERR_STR);
  467. return false;
  468. }
  469. FuriString *fs = furi_string_alloc();
  470. furi_string_set_strn(fs, (char*)furi_string_get_cstr(cmd), p - (char*)furi_string_get_cstr(cmd));
  471. furi_string_cat_str(fs, ": ");
  472. bool hexval;
  473. if((hexval = *(p + strlen(p) - 1) == '#')) furi_string_cat_str(fs, "0x"); // value in Hex format
  474. Log[Log_Total++] = fs;
  475. p++;
  476. memset(payload, 0, sizeof(payload));
  477. if(ReadDefault && !fill_payload((char*)furi_string_get_cstr(ReadDefault), NULL, VAR_EMPTY)) return false;
  478. if(!fill_payload(p, &cmd_array_idx, VAR_EMPTY)) return false;
  479. memset(payload_receive, 0, sizeof(payload_receive));
  480. cmd_array = false;
  481. if(*(p - 2) == ']' && cmd_array_idx != 255) { // array
  482. p = strchr(furi_string_get_cstr(cmd), '[');
  483. if(p) {
  484. cmd_array_cnt = str_to_int(p + 1);
  485. if(cmd_array_cnt > 1) {
  486. cmd_array_hex = hexval;
  487. cmd_array = true; // array
  488. }
  489. }
  490. }
  491. prepare_nrf24();
  492. if(NRF_ERROR) return false;
  493. what_doing = 2;
  494. NRF_repeat = 0;
  495. send_status = sst_sending; // Read - sending
  496. nrf24_send_packet();
  497. return true;
  498. }
  499. // run commands one by one, true - command running
  500. bool Run_ReadBatch_cmd(FuriString *cmd)
  501. {
  502. char *p;
  503. if(cmd) {
  504. p = strchr((char*)furi_string_get_cstr(cmd), ':');
  505. if(p == NULL) {
  506. ERR = 5;
  507. strcpy(ERR_STR, "WRONG FORMAT");
  508. return false;
  509. }
  510. p += 2;
  511. ReadBatch_cmd_curr = NULL;
  512. free_Log();
  513. } else {
  514. if(ReadBatch_cmd_curr) p = ReadBatch_cmd_curr; else return false;
  515. }
  516. char *end = strchr(p, ';');
  517. uint8_t len;
  518. if(end) len = end - p;
  519. else {
  520. str_rtrim(p);
  521. len = strlen(p);
  522. }
  523. for(uint16_t i = 0; i < Read_cmd_Total; i++) {
  524. FuriString *fs = Read_cmd[i];
  525. if(strncmp((char*)furi_string_get_cstr(fs), p, len) == 0) {
  526. char c = *((char*)furi_string_get_cstr(fs) + len);
  527. if(c != '=' && c != '*' && c != '[') continue;
  528. if(end) ReadBatch_cmd_curr = end + 1; else ReadBatch_cmd_curr = (char*)0xFFFFFFFF;
  529. if(!Run_Read_cmd(fs)) break;
  530. return true;
  531. }
  532. }
  533. if(NRF_ERROR) return false;
  534. if(ERR == 0) {
  535. ERR = 4;
  536. strcpy(ERR_STR, "NOT FOUND");
  537. FuriString *fs = furi_string_alloc();
  538. furi_string_set_strn(fs, p, len);
  539. Log[Log_Total++] = fs;
  540. FURI_LOG_D(TAG, "CMD %s: %s", ERR_STR, p);
  541. }
  542. view_Batch = Log_Total ? Log_Total - 1 : 0;
  543. return false;
  544. }
  545. void Prepare_Write_cmd(FuriString *cmd)
  546. {
  547. if(cmd == NULL) return;
  548. char *end, *p = strchr((char*)furi_string_get_cstr(cmd), ':');
  549. if(p == NULL) return;
  550. p += 2;
  551. free_Log();
  552. Log = malloc(sizeof(Log));
  553. do {
  554. end = strchr(p, ';');
  555. uint8_t len;
  556. if(end) {
  557. len = end - p;
  558. end++;
  559. } else {
  560. str_rtrim(p);
  561. len = strlen(p);
  562. }
  563. FuriString *fs = furi_string_alloc();
  564. if(Log_Total) Log = realloc(Log, sizeof(Log) * (Log_Total + 1));
  565. if(Log == NULL) {
  566. ERR = 3;
  567. strcpy(ERR_STR, "Memory low");
  568. FURI_LOG_D(TAG, ERR_STR);
  569. return;
  570. }
  571. furi_string_set_strn(fs, p, len);
  572. Log[Log_Total++] = fs;
  573. } while((p = end));
  574. }
  575. bool Run_WriteBatch_cmd()
  576. {
  577. if(Log_Total == 0) return false;
  578. if(WriteBatch_cmd_curr == 0) { // first
  579. prepare_nrf24();
  580. if(NRF_ERROR) return false;
  581. if(WriteStart) {
  582. if(!fill_payload((char*)furi_string_get_cstr(WriteStart), NULL, VAR_EMPTY)) return false;
  583. send_status = sst_sending;
  584. if(!nrf24_send_packet()) return false;
  585. }
  586. }
  587. char *p = (char*)furi_string_get_cstr(Log[WriteBatch_cmd_curr]);
  588. uint16_t len = furi_string_size(Log[WriteBatch_cmd_curr]);
  589. char *arr = NULL;
  590. cmd_array = false;
  591. int32_t new = 0;
  592. for(uint16_t i = 0; i < len; i++) {
  593. if(p[i] == '=') {
  594. len = i;
  595. char *p2 = p + i + 1;
  596. if(*p2 == '{') {
  597. arr = ++p2; // array
  598. cmd_array = true;
  599. }
  600. new = str_to_int(p2);
  601. break;
  602. }
  603. }
  604. FURI_LOG_D(TAG, "WriteBatch: =%d, (%d)%s", (int)new, len, p);
  605. char *w, *delim_col, i;
  606. FuriString* str = furi_string_alloc();
  607. stream_rewind(file_stream);
  608. while(stream_read_line(file_stream, str)) {
  609. w = (char*)furi_string_get_cstr(str);
  610. if(strncmp(w, SettingsFld_Write, sizeof(SettingsFld_Write)-1) != 0) continue;
  611. w += sizeof(SettingsFld_Write);
  612. delim_col = strchr(w, '=');
  613. if(delim_col == NULL || len != delim_col - w) continue;
  614. if(strncmp(p, w, len) != 0) continue;
  615. delim_col++;
  616. str_rtrim(delim_col);
  617. cmd_array_cnt = 255;
  618. do {
  619. memset(payload, 0, sizeof(payload));
  620. if(WriteDefault && !fill_payload((char*)furi_string_get_cstr(WriteDefault), NULL, new)) {
  621. view_Batch = WriteBatch_cmd_curr;
  622. return false;
  623. }
  624. if(!fill_payload(delim_col, &cmd_array_idx, VAR_EMPTY)) {
  625. view_Batch = WriteBatch_cmd_curr;
  626. return false;
  627. }
  628. if(cmd_array && cmd_array_idx != 255) {
  629. if(cmd_array_cnt != 255) payload[cmd_array_idx] = cmd_array_cnt;
  630. } else cmd_array = false;
  631. send_status = sst_sending;
  632. NRF_repeat = 0;
  633. i = 0;
  634. do {
  635. if(nrf24_send_packet()) break;
  636. furi_delay_ms(delay_between_pkt);
  637. } while(i++ < NRF_resend);
  638. if(i < NRF_resend || i == 0) { // ok
  639. if(cmd_array) { // array
  640. for(; arr != NULL;) {
  641. if(*arr == ',') break;
  642. if(*arr == '}' || *arr < ' ') arr = NULL; else arr++;
  643. }
  644. if(arr == NULL) {
  645. send_status = sst_ok;
  646. break;
  647. }
  648. arr++;
  649. new = str_to_int(arr);
  650. cmd_array_cnt = payload[cmd_array_idx] + 1;
  651. continue;
  652. } else send_status = sst_ok;
  653. }
  654. break;
  655. } while(1);
  656. if(send_status != sst_ok) {
  657. send_status = sst_error;
  658. view_Batch = WriteBatch_cmd_curr;
  659. return false;
  660. }
  661. return true;
  662. }
  663. ERR = 7;
  664. strcpy(ERR_STR, "NOT FOUND!");
  665. send_status = sst_error;
  666. view_Batch = WriteBatch_cmd_curr;
  667. return false;
  668. }
  669. // Return 0 - success, otherwise an error
  670. static uint8_t load_settings_file() {
  671. uint8_t err = 0;
  672. FURI_LOG_D(TAG, "Loading settings file");
  673. FuriString* str = furi_string_alloc();
  674. free_store();
  675. Info[0] = '\0';
  676. NRF_INITED = false;
  677. while(stream_read_line(file_stream, str)) {
  678. char *p = (char*)furi_string_get_cstr(str);
  679. if(*p <= ' ') continue;
  680. //char* delim_eq = strchr(p, '=');
  681. char* delim_col = strchr(p, ':');
  682. if(delim_col == NULL) { // Constant found - no ':'
  683. if(Constants == NULL) {
  684. Constants = furi_string_alloc_set(str);
  685. } else furi_string_cat(Constants, str);
  686. } else {
  687. str_rtrim(p);
  688. if(strncmp(p, SettingsFld_Rate, sizeof(SettingsFld_Rate)-1) == 0) {
  689. NRF_rate = str_to_int(p + sizeof(SettingsFld_Rate));
  690. } else if(strncmp(p, SettingsFld_Info, sizeof(SettingsFld_Info)-1) == 0) {
  691. strncpy(Info, p + sizeof(SettingsFld_Info), sizeof(Info)-1);
  692. } else if(strncmp(p, SettingsFld_Ch, sizeof(SettingsFld_Ch)-1) == 0) {
  693. NRF_channel = str_to_int(p + sizeof(SettingsFld_Ch));
  694. } else if(strncmp(p, SettingsFld_Address, sizeof(SettingsFld_Address)-1) == 0) {
  695. p += sizeof(SettingsFld_Address);
  696. addr_len = ConvertHexToArray(p, addr, 5);
  697. } else if(strncmp(p, SettingsFld_CRC, sizeof(SettingsFld_CRC)-1) == 0) {
  698. NRF_CRC = str_to_int(p + sizeof(SettingsFld_CRC));
  699. } else if(strncmp(p, SettingsFld_DPL, sizeof(SettingsFld_DPL)-1) == 0) {
  700. NRF_DPL = str_to_int(p + sizeof(SettingsFld_DPL));
  701. } else if(strncmp(p, SettingsFld_RETR, sizeof(SettingsFld_RETR)-1) == 0) {
  702. NRF_RETR = str_to_int(p + sizeof(SettingsFld_RETR));
  703. } else if(strncmp(p, SettingsFld_Resend, sizeof(SettingsFld_Resend)-1) == 0) {
  704. NRF_resend = str_to_int(p + sizeof(SettingsFld_Resend));
  705. } else if(strncmp(p, SettingsFld_Delay, sizeof(SettingsFld_Delay)-1) == 0) {
  706. delay_between_pkt = str_to_int(p + sizeof(SettingsFld_Delay));
  707. } else if(strncmp(p, SettingsFld_Payload, sizeof(SettingsFld_Payload)-1) == 0) {
  708. p += sizeof(SettingsFld_Payload);
  709. payload_fields = 0;
  710. payload_size = 0;
  711. do {
  712. uint8_t b = str_to_int(p);
  713. if(b < 1 || b > 4) {
  714. FURI_LOG_D(TAG, "Wrong payload format (%d)", b);
  715. err = 3;
  716. break;
  717. }
  718. payload_struct[payload_fields++] = b;
  719. payload_size += b;
  720. if(payload_fields == sizeof(payload_struct) - 1) break;
  721. if((p = strchr(p, ',')) == NULL) break;
  722. p++;
  723. } while(1);
  724. FURI_LOG_D(TAG, "Payload fields %d: %d,%d,%d", payload_fields, payload_struct[0], payload_struct[1], payload_struct[2]);
  725. } else if(strncmp(p, SettingsFld_ReadDefault, sizeof(SettingsFld_ReadDefault)-1) == 0) {
  726. ReadDefault = furi_string_alloc_set_str(p + sizeof(SettingsFld_ReadDefault));
  727. } else if(strncmp(p, SettingsFld_WriteStart, sizeof(SettingsFld_WriteStart)-1) == 0) {
  728. WriteStart = furi_string_alloc_set_str(p + sizeof(SettingsFld_WriteStart));
  729. } else if(strncmp(p, SettingsFld_WriteDefault, sizeof(SettingsFld_WriteDefault)-1) == 0) {
  730. WriteDefault = furi_string_alloc_set_str(p + sizeof(SettingsFld_WriteDefault));
  731. } else if(strncmp(p, SettingsFld_Read, sizeof(SettingsFld_Read)-1) == 0) {
  732. p += sizeof(SettingsFld_Read);
  733. if(Read_cmd == NULL) Read_cmd = malloc(sizeof(Read_cmd));
  734. else {
  735. Read_cmd = realloc(Read_cmd, sizeof(Read_cmd) * (Read_cmd_Total + 1));
  736. }
  737. if(Read_cmd == NULL) {
  738. FURI_LOG_D(TAG, "Memory low, err 4");
  739. err = 4;
  740. break;
  741. }
  742. Read_cmd[Read_cmd_Total++] = furi_string_alloc_set_str(p);
  743. } else if(strncmp(p, SettingsFld_ReadBatch, sizeof(SettingsFld_ReadBatch)-1) == 0) {
  744. p += sizeof(SettingsFld_ReadBatch);
  745. if(ReadBatch_cmd == NULL) ReadBatch_cmd = malloc(sizeof(ReadBatch_cmd));
  746. else {
  747. ReadBatch_cmd = realloc(ReadBatch_cmd, sizeof(ReadBatch_cmd) * (ReadBatch_cmd_Total + 1));
  748. }
  749. if(ReadBatch_cmd == NULL) {
  750. FURI_LOG_D(TAG, "Memory low, err 5");
  751. err = 5;
  752. break;
  753. }
  754. ReadBatch_cmd[ReadBatch_cmd_Total++] = furi_string_alloc_set_str(p);
  755. } else if(strncmp(p, SettingsFld_WriteBatch, sizeof(SettingsFld_WriteBatch)-1) == 0) {
  756. p += sizeof(SettingsFld_WriteBatch);
  757. if(WriteBatch_cmd == NULL) WriteBatch_cmd = malloc(sizeof(WriteBatch_cmd));
  758. else {
  759. WriteBatch_cmd = realloc(WriteBatch_cmd, sizeof(WriteBatch_cmd) * (WriteBatch_cmd_Total + 1));
  760. }
  761. if(WriteBatch_cmd == NULL) {
  762. FURI_LOG_D(TAG, "Memory low, err 6");
  763. err = 6;
  764. break;
  765. }
  766. WriteBatch_cmd[WriteBatch_cmd_Total++] = furi_string_alloc_set_str(p);
  767. }
  768. }
  769. }
  770. furi_string_free(str);
  771. return err;
  772. }
  773. static void save_batch(void)
  774. {
  775. FURI_LOG_D(TAG, "Save Batch");
  776. char *p, *p2;
  777. stream_seek(file_stream, 0, StreamOffsetFromEnd);
  778. FuriHalRtcDateTime dt;
  779. furi_hal_rtc_get_datetime(&dt);
  780. stream_write_format(file_stream, "\n%s ", SettingsFld_WriteBatch);
  781. p = (char*)furi_string_get_cstr(ReadBatch_cmd[view_cmd[rwt_read_batch]]);
  782. p2 = strchr(p, ':');
  783. if(p2 == NULL) p2 = p + strlen(p);
  784. stream_write(file_stream, (uint8_t*)p, p2 - p);
  785. stream_write_format(file_stream, " %02d.%02d.%02d %02d.%02d: ", dt.day, dt.month, dt.year % 100, dt.hour, dt.minute);
  786. for(uint16_t i = 0; i < Log_Total; i++) {
  787. p = (char*) furi_string_get_cstr(Log[i]);
  788. p2 = strchr(p, ':');
  789. if(p2 && *(p2-1) != '*') { // skip string
  790. if(*(p2-1) == ']') { // array
  791. char *p3 = strchr(p, '[');
  792. if(p3 == NULL) p3 = p2;
  793. stream_write(file_stream, (uint8_t*)p, p3 - p);
  794. stream_write_cstring(file_stream, "={");
  795. p = (p2 += 2);
  796. do {
  797. while(is_digit(p2, true) || *p2 == 'x') p2++;
  798. stream_write(file_stream, (uint8_t*)p, p2 - p);
  799. char c = *p2;
  800. if(c == '\0') break;
  801. if(c != ',') {
  802. p2 = strchr(p2, ',');
  803. if(p2 == NULL) break;
  804. }
  805. stream_write_char(file_stream, ',');
  806. p = ++p2;
  807. } while(1);
  808. stream_write_char(file_stream, '}');
  809. } else {
  810. stream_write(file_stream, (uint8_t*)p, p2 - p - (*(p2-2) == '*' ? 2 : 0));
  811. stream_write_char(file_stream, '=');
  812. p2 += 2;
  813. p = strchr(p2, ' ');
  814. if(p == NULL) p = p2 + strlen(p2);
  815. stream_write(file_stream, (uint8_t*)p2, p - p2);
  816. }
  817. if(i < Log_Total - 1) stream_write_char(file_stream, ';');
  818. }
  819. }
  820. }
  821. static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) {
  822. furi_assert(event_queue);
  823. PluginEvent event = {.type = EventTypeKey, .input = *input_event};
  824. furi_message_queue_put(event_queue, &event, FuriWaitForever);
  825. }
  826. void render_display_list(Canvas* const canvas, FuriString ***fsa, char delim, uint16_t view_pos, uint16_t max_i)
  827. {
  828. uint16_t page = view_pos & ~7;
  829. char *p, *end;
  830. uint16_t y, len;
  831. for(uint8_t i = 0; i < 8 && page + i < max_i; i++) {
  832. y = 14 + i * 7;
  833. p = (char*) furi_string_get_cstr((*fsa)[page + i]);
  834. end = strchr(p, delim);
  835. if(end) {
  836. if(*(end - 1) == '*') end--; // skip *
  837. else if(*(end - 2) == '*') end -= 2; // skip *?
  838. len = MIN(end - p, view_x);
  839. len = MIN(end - p - len, FONT_5x7_SCREEN_WIDTH);
  840. strncpy(screen_buf, p + view_x, len);
  841. screen_buf[len] = '\0';
  842. canvas_draw_str(canvas, 5, y, screen_buf);
  843. }
  844. if((view_pos & 7) == i) {
  845. canvas_draw_str(canvas, 0, y, ">");
  846. canvas_draw_str(canvas, -1, y, ">");
  847. }
  848. }
  849. }
  850. void display_remove_asterisk(char *fsp, uint8_t vx)
  851. {
  852. char *p2 = strchr(fsp, '*');
  853. if(p2) { // remove '*' or '*n'
  854. int pos = p2 - fsp;
  855. if((pos -= vx) < 0) pos = 0;
  856. memmove(screen_buf + pos, screen_buf + pos + (*(p2 + 1) == ':' ? 1 : 2), FONT_5x7_SCREEN_WIDTH + 1 + 2);
  857. }
  858. }
  859. static void render_callback(Canvas* const canvas, void* ctx) {
  860. const PluginState* plugin_state = acquire_mutex((ValueMutex*)ctx, 25);
  861. if(plugin_state == NULL) return;
  862. //canvas_draw_frame(canvas, 0, 0, 128, 64); // border around the edge of the screen
  863. if(what_doing == 0) {
  864. canvas_set_font(canvas, FontSecondary); // 8x10 font, 6 lines
  865. snprintf(screen_buf, sizeof(screen_buf), "%s: %s", addr_len ? "File" : "Open", file_name);
  866. canvas_draw_str(canvas, 8, 10, screen_buf);
  867. if(addr_len) {
  868. if(Edit) {
  869. screen_buf[0] = *Edit_pos; screen_buf[1] = '\0';
  870. int n = canvas_string_width(canvas, screen_buf);
  871. int len = Edit_pos - Edit_start;
  872. memcpy(screen_buf, Edit_start, len);
  873. screen_buf[len] = '\0';
  874. int x = setup_cursor == 1 ? 45 : 55;
  875. x += canvas_string_width(canvas, screen_buf);
  876. int len2 = strlen(Edit_pos);
  877. memcpy(screen_buf + len, Edit_pos, len2);
  878. screen_buf[len + len2] = '\0';
  879. int y = 10 + setup_cursor * 10;
  880. if(setup_cursor == 1) canvas_draw_str(canvas, 45, 20, screen_buf);
  881. else if(setup_cursor == 2) canvas_draw_str(canvas, 55, 30, screen_buf);
  882. canvas_draw_line(canvas, x + (len ? 1 : 0), y + 1, x + n + (*Edit_pos == '1' && len ? 1 : 0), y + 1);
  883. }
  884. if(!Edit || setup_cursor != 1) {
  885. screen_buf[0] = '\0';
  886. add_to_str_hex_bytes(screen_buf, addr, addr_len);
  887. canvas_draw_str(canvas, 45, 20, screen_buf);
  888. }
  889. if(!Edit || setup_cursor != 2) {
  890. snprintf(screen_buf, sizeof(screen_buf), "%d", NRF_channel);
  891. canvas_draw_str(canvas, 55, 30, screen_buf);
  892. }
  893. canvas_draw_str(canvas, 8, 20, "Address:");
  894. snprintf(screen_buf, sizeof(screen_buf), "Rate: %d, Ch:", NRF_rate);
  895. canvas_draw_str(canvas, 8, 30, screen_buf);
  896. snprintf(screen_buf, sizeof(screen_buf), "RB: %d, R: %d, WB: %d", ReadBatch_cmd_Total, Read_cmd_Total, WriteBatch_cmd_Total);
  897. canvas_draw_str(canvas, 8, 40, screen_buf);
  898. canvas_draw_str(canvas, 0, 64, Info);
  899. canvas_draw_str(canvas, 0, 10 + setup_cursor * 10, ">");
  900. } else {
  901. snprintf(screen_buf, sizeof(screen_buf), "Ver. %s, vad7", VERSION);
  902. canvas_draw_str(canvas, 10, 60, screen_buf);
  903. canvas_draw_str(canvas, 0, 10, ">");
  904. }
  905. } else if(what_doing == 1){
  906. canvas_set_font(canvas, FontBatteryPercent); // 5x7 font, 9 lines, 25 cols
  907. if(rw_type == rwt_read_batch) {
  908. canvas_draw_str(canvas, 0, 7, "Read Batch:");
  909. render_display_list(canvas, &ReadBatch_cmd, ':', view_cmd[rw_type], ReadBatch_cmd_Total);
  910. } else if(rw_type == rwt_read_cmd) {
  911. canvas_draw_str(canvas, 0, 7, "Read Command:");
  912. render_display_list(canvas, &Read_cmd, '=', view_cmd[rw_type], Read_cmd_Total);
  913. } else { // rwt_write_batch
  914. if(!ask_fill_screen_buf()) strcpy(screen_buf, "Write Batch:");
  915. canvas_draw_str(canvas, 0, 7, screen_buf);
  916. render_display_list(canvas, &WriteBatch_cmd, ':', view_cmd[rw_type], WriteBatch_cmd_Total);
  917. }
  918. if(NRF_ERROR) canvas_draw_str(canvas, 70, 7, "nRF24 ERROR!");
  919. } else { // what_doing == 2
  920. if(rw_type == rwt_read_cmd) { // Read command
  921. canvas_set_font(canvas, FontSecondary); // 8x10 font, 6 lines
  922. if(!ask_fill_screen_buf()) strcpy(screen_buf, "Read cmd: ");
  923. if(NRF_ERROR) strcat(screen_buf, "nRF24 ERROR!");
  924. else if(ERR) {
  925. snprintf(screen_buf + strlen(screen_buf), FONT_5x7_SCREEN_WIDTH, "ERROR %d", ERR);
  926. canvas_draw_str(canvas, 0, 60, ERR_STR);
  927. } else if(send_status == sst_sending) strcat(screen_buf, "sending");
  928. else if(send_status == sst_receiving) strcat(screen_buf, "receiving");
  929. else if(send_status == sst_error) strcat(screen_buf, "NO ACK!");
  930. else if(send_status == sst_timeout) strcat(screen_buf, "TIMEOUT!");
  931. else if(send_status == sst_ok) strcat(screen_buf, "OK");
  932. canvas_draw_str(canvas, 0, 10, screen_buf);
  933. if(Log_Total) {
  934. char *p = (char*)furi_string_get_cstr(Log[Log_Total - 1]);
  935. uint8_t vx = MIN(view_x, strlen(p));
  936. strncpy(screen_buf, p + vx, 30);
  937. display_remove_asterisk(p, vx);
  938. canvas_draw_str(canvas, 0, 15 + 10, screen_buf);
  939. }
  940. } else { // if(rw_type == rwt_read_batch || rw_type == rwt_write_batch)
  941. canvas_set_font(canvas, FontBatteryPercent); // 5x7 font, 9 lines, 25 cols
  942. if(!ask_fill_screen_buf()) {
  943. strcpy(screen_buf, rw_type == rwt_read_batch ? "Read Batch: " : what_doing == 1 ? "Write Batch: " : "Write: ");
  944. if(rw_type == rwt_read_batch || send_status != sst_none) {
  945. if(NRF_ERROR) strcat(screen_buf, "nRF24 ERROR!");
  946. else if(ERR) snprintf(screen_buf, sizeof(screen_buf), "ERROR %s", ERR_STR);
  947. else if(send_status == sst_error) strcat(screen_buf, "NO ACK!");
  948. else if(send_status == sst_timeout) strcat(screen_buf, "TIMEOUT!");
  949. else if(send_status == sst_ok && ((rw_type == rwt_read_batch && (uint32_t)ReadBatch_cmd_curr == 0xFFFFFFFF)
  950. || (rw_type == rwt_write_batch && WriteBatch_cmd_curr == Log_Total)))
  951. strcat(screen_buf, "OK");
  952. else strcat(screen_buf, "working");
  953. } else if(rw_type == rwt_write_batch) {
  954. char *p = (char*)furi_string_get_cstr(WriteBatch_cmd[view_cmd[rwt_write_batch]]);
  955. char *end = strchr(p, ':');
  956. if(end) {
  957. uint8_t len = end - p;
  958. uint8_t lenb = strlen(screen_buf);
  959. end = screen_buf + lenb;
  960. lenb = FONT_5x7_SCREEN_WIDTH - lenb;
  961. if(len > lenb) {
  962. if(view_x < len) {
  963. strncpy(end, p + view_x, len = MIN(lenb, len - view_x));
  964. end[len] = '\0';
  965. }
  966. } else {
  967. strncpy(end, p, len);
  968. end[len] = '\0';
  969. }
  970. }
  971. }
  972. }
  973. canvas_draw_str(canvas, 0, 7, screen_buf);
  974. if(Log_Total) {
  975. char *p;
  976. uint16_t y, page = view_Batch & ~7;
  977. uint8_t vx;
  978. for(uint8_t i = 0; i < 8 && page + i < Log_Total; i++) {
  979. p = (char*)furi_string_get_cstr(Log[page + i]);
  980. y = 14 + i * 7;
  981. vx = MIN(view_x, strlen(p));
  982. if((view_Batch & 7) == i) {
  983. canvas_draw_str(canvas, 0, y, ">");
  984. canvas_draw_str(canvas, -1, y, ">");
  985. if(Edit) {
  986. int n = Edit_pos - p - vx - (FONT_5x7_SCREEN_WIDTH - 4);
  987. if(n > 0) vx += n; // fix out of screen
  988. int x = 6 + (Edit_pos - p - vx) * 5;
  989. canvas_draw_line(canvas, x - 1, y, x - 1, y - 1);
  990. canvas_draw_line(canvas, x - 1, y, n = x + 1 * 5, y);
  991. canvas_draw_line(canvas, n, y, n, y - 1);
  992. }
  993. }
  994. strncpy(screen_buf, p + vx, FONT_5x7_SCREEN_WIDTH + 2);
  995. screen_buf[FONT_5x7_SCREEN_WIDTH + 2] = '\0';
  996. display_remove_asterisk(p, vx);
  997. canvas_draw_str(canvas, 6, y, screen_buf);
  998. }
  999. }
  1000. }
  1001. }
  1002. release_mutex((ValueMutex*)ctx, plugin_state);
  1003. }
  1004. void work_timer_callback(void* ctx)
  1005. {
  1006. UNUSED(ctx);
  1007. if(what_doing == 2) {
  1008. if(rw_type == rwt_write_batch) {
  1009. if(send_status == sst_ok) {
  1010. if(ERR == 0 && WriteBatch_cmd_curr < Log_Total && furi_get_tick() - NRF_time >= delay_between_pkt) {
  1011. if(++WriteBatch_cmd_curr < Log_Total) Run_WriteBatch_cmd(); else Edited = false;
  1012. }
  1013. } else if(send_status == sst_sending) {
  1014. if(NRF_repeat++ < NRF_resend) nrf24_send_packet();
  1015. else {
  1016. view_Batch = WriteBatch_cmd_curr;
  1017. send_status = sst_error; // error NO_ACK
  1018. }
  1019. }
  1020. // ReadBatch or ReadCmd
  1021. } else if(send_status == sst_sending) { // sending
  1022. // if(!NRF_last_packet_send_st) { // No ACK on last attempt
  1023. if(furi_get_tick() - NRF_time > delay_between_pkt) {
  1024. if(NRF_repeat++ < NRF_resend) {
  1025. if(cmd_array) nrf24_send_packet(); else nrf24_resend_read_packet();
  1026. } else send_status = sst_error; // error NO_ACK
  1027. }
  1028. // }
  1029. } else if(send_status == sst_receiving) { // receiving
  1030. for(uint8_t i = 0; i < 3; i++) {
  1031. bool new = nrf24_read_newpacket();
  1032. if(new) {
  1033. if(send_status != sst_receiving) break;
  1034. } else if(furi_get_tick() - NRF_time > NRF_READ_TIMEOUT) {
  1035. if(NRF_repeat++ < NRF_resend) {
  1036. send_status = sst_sending;
  1037. nrf24_resend_read_packet();
  1038. } else {
  1039. FURI_LOG_D(TAG, "TIMEOUT: %lu", furi_get_tick() - NRF_time);
  1040. send_status = sst_timeout;
  1041. }
  1042. break;
  1043. }
  1044. }
  1045. } else if(send_status == sst_ok) {
  1046. if(rw_type == rwt_read_batch) {
  1047. if((uint32_t)ReadBatch_cmd_curr != 0xFFFFFFFF && ERR == 0 && furi_get_tick() - NRF_time >= delay_between_pkt) {
  1048. Run_ReadBatch_cmd(NULL);
  1049. }
  1050. }
  1051. }
  1052. }
  1053. }
  1054. int32_t nrf24batch_app(void* p) {
  1055. UNUSED(p);
  1056. APP = malloc(sizeof(nRF24Batch));
  1057. APP->event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent));
  1058. APP->plugin_state = malloc(sizeof(PluginState));
  1059. ValueMutex state_mutex;
  1060. if(!init_mutex(&state_mutex, APP->plugin_state, sizeof(PluginState))) {
  1061. furi_message_queue_free(APP->event_queue);
  1062. FURI_LOG_E(TAG, "cannot create mutex");
  1063. free(APP->plugin_state);
  1064. return 255;
  1065. }
  1066. nrf24_init();
  1067. // Set system callbacks
  1068. APP->view_port = view_port_alloc();
  1069. view_port_draw_callback_set(APP->view_port, render_callback, &state_mutex);
  1070. view_port_input_callback_set(APP->view_port, input_callback, APP->event_queue);
  1071. // Open GUI and register view_port
  1072. APP->gui = furi_record_open(RECORD_GUI);
  1073. gui_add_view_port(APP->gui, APP->view_port, GuiLayerFullscreen);
  1074. APP->notification = furi_record_open(RECORD_NOTIFICATION);
  1075. APP->storage = furi_record_open(RECORD_STORAGE);
  1076. storage_common_mkdir(APP->storage, SCAN_APP_PATH_FOLDER);
  1077. file_stream = file_stream_alloc(APP->storage);
  1078. FuriTimer *work_timer = furi_timer_alloc(work_timer_callback, FuriTimerTypePeriodic, NULL);
  1079. furi_timer_start(work_timer, WORK_PERIOD);
  1080. PluginEvent event;
  1081. for(bool processing = true; processing;) {
  1082. FuriStatus event_status = furi_message_queue_get(APP->event_queue, &event, 200);
  1083. PluginState* plugin_state = (PluginState*)acquire_mutex_block(&state_mutex);
  1084. static FuriLogLevel FuriLogLevel = FuriLogLevelDefault;
  1085. if(furi_log_get_level() != FuriLogLevel) {
  1086. FuriLogLevel = furi_log_get_level();
  1087. if(FuriLogLevel == FuriLogLevelDebug) furi_hal_uart_set_br(FuriHalUartIdUSART1, 1843200);
  1088. }
  1089. if(event_status == FuriStatusOk) {
  1090. // press events
  1091. if(event.type == EventTypeKey) {
  1092. switch(event.input.key) {
  1093. case InputKeyUp:
  1094. if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) {
  1095. if(!ask_question) {
  1096. if(Edit) {
  1097. if(*Edit_pos < '9') (*Edit_pos)++;
  1098. else if(Edit_hex) {
  1099. if(*Edit_pos == '9') *Edit_pos = 'A';
  1100. else if((*Edit_pos & ~0x20) < 'F') (*Edit_pos)++;
  1101. } else if(Edit_pos > Edit_start && *(Edit_pos - 1) < '9') {
  1102. *Edit_pos = '0';
  1103. (*(Edit_pos - 1))++;
  1104. }
  1105. } else if(what_doing == 0) {
  1106. if(addr_len) {
  1107. if(setup_cursor > 0) setup_cursor--; else setup_cursor = 2;
  1108. }
  1109. } else if(what_doing == 1) {
  1110. if(view_cmd[rw_type]) view_cmd[rw_type]--;
  1111. } else if(what_doing == 2) {
  1112. if(view_Batch) view_Batch--;
  1113. }
  1114. }
  1115. }
  1116. break;
  1117. case InputKeyDown:
  1118. if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) {
  1119. if(!ask_question) {
  1120. if(Edit) {
  1121. if(Edit_hex && (*Edit_pos & ~0x20) == 'A') (*Edit_pos) = '9';
  1122. else if(*Edit_pos > '0') (*Edit_pos)--;
  1123. else if(!Edit_hex && Edit_pos > Edit_start && *(Edit_pos - 1) > '0') {
  1124. *Edit_pos = '9';
  1125. (*(Edit_pos - 1))--;
  1126. }
  1127. } else if(what_doing == 0) {
  1128. if(addr_len) {
  1129. if(setup_cursor < 2) setup_cursor++; else setup_cursor = 0;
  1130. }
  1131. } else if(what_doing == 1) {
  1132. if(view_cmd[rw_type] + 1 < (rw_type == rwt_read_batch ? ReadBatch_cmd_Total : rw_type == rwt_read_cmd ? Read_cmd_Total : WriteBatch_cmd_Total)) view_cmd[rw_type]++;
  1133. } else if(what_doing == 2) {
  1134. if(view_Batch < Log_Total - 1) view_Batch++;
  1135. }
  1136. }
  1137. }
  1138. break;
  1139. case InputKeyLeft:
  1140. if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) {
  1141. if(ask_question) {
  1142. if(event.input.type == InputTypeShort) ask_question_answer ^= 1;
  1143. } else if(Edit) {
  1144. if(Edit_pos > Edit_start) {
  1145. if(is_digit(Edit_pos - 1, Edit_hex)) Edit_pos--;
  1146. else if(*(Edit_pos - 1) == 'x' && *(Edit_pos - 3) == ',') Edit_pos -= 4;
  1147. else if(*(Edit_pos - 1) == ',') Edit_pos -= 2;
  1148. }
  1149. } else if(what_doing == 0) {
  1150. rw_type = rwt_write_batch;
  1151. what_doing = 1;
  1152. } else if(what_doing == 1) {
  1153. if(event.input.type == InputTypeShort) {
  1154. if(--rw_type > rwt_write_batch) rw_type = rwt_write_batch;
  1155. } else if(view_x) view_x--;
  1156. } else if(what_doing == 2) {
  1157. if(view_x) view_x--;
  1158. }
  1159. } else if(event.input.type == InputTypeLong) {
  1160. if(!ask_question && view_x == 0 && what_doing == 2 && (rw_type == rwt_write_batch || rw_type == rwt_read_batch)
  1161. && Log_Total && Log[view_Batch] != NULL) {
  1162. ask_question = ask_skip_cmd;
  1163. ask_question_answer = 1;
  1164. }
  1165. }
  1166. break;
  1167. case InputKeyRight:
  1168. if(event.input.type == InputTypeShort || event.input.type == InputTypeRepeat) {
  1169. if(ask_question) {
  1170. ask_question_answer ^= 1;
  1171. } else if(Edit) {
  1172. if(is_digit(Edit_pos + 1, Edit_hex)) Edit_pos++;
  1173. else if(*(Edit_pos + 1) == ',') {
  1174. Edit_pos += 2;
  1175. if(*(Edit_pos + 1) == 'x') Edit_pos += 2;
  1176. }
  1177. } else if(what_doing == 0) {
  1178. rw_type = rwt_read_batch;
  1179. what_doing = 1;
  1180. } else if(what_doing == 1) {
  1181. if(event.input.type == InputTypeShort) {
  1182. if(++rw_type > rwt_write_batch) rw_type = rwt_read_batch;
  1183. } else view_x++;
  1184. } else if(what_doing == 2) {
  1185. view_x++;
  1186. }
  1187. }
  1188. break;
  1189. case InputKeyOk:
  1190. if(event.input.type == InputTypeShort) {
  1191. if(ask_question) {
  1192. if(ask_question_answer) {
  1193. if(ask_question == ask_save_batch) {
  1194. save_batch();
  1195. } else if(ask_question == ask_write_batch) {
  1196. ERR = 0;
  1197. WriteBatch_cmd_curr = 0;
  1198. Run_WriteBatch_cmd();
  1199. what_doing = 2;
  1200. } else if(ask_question == ask_skip_cmd) {
  1201. if(rw_type == rwt_write_batch || rw_type == rwt_read_batch) {
  1202. furi_string_free(Log[view_Batch]);
  1203. if(view_Batch < Log_Total - 1) memmove(&Log[view_Batch], &Log[view_Batch + 1], sizeof(Log) * (Log_Total - view_Batch - 1));
  1204. else view_Batch--;
  1205. Log_Total--;
  1206. }
  1207. } else if(ask_question == ask_exit) {
  1208. processing = false;
  1209. } else if(ask_question == ask_return) {
  1210. if(what_doing == 2) {
  1211. ERR = 0;
  1212. send_status = sst_none;
  1213. Edited = false;
  1214. what_doing--;
  1215. }
  1216. }
  1217. }
  1218. ask_question = 0;
  1219. } else if(Edit) { // insert digit
  1220. if(what_doing == 0) {
  1221. if(strlen(Edit_start) < (setup_cursor == 1 ? 5 * 2 : 3)) {
  1222. memmove(Edit_pos + 1, Edit_pos, strlen(Edit_pos) + 1);
  1223. *Edit_pos = '0';
  1224. }
  1225. } else {
  1226. FuriString *fs = Log[view_Batch];
  1227. FuriString *ns = furi_string_alloc();
  1228. if(ns) {
  1229. uint16_t len = Edit_pos - (char*)furi_string_get_cstr(fs);
  1230. furi_string_set_n(ns, fs, 0, len);
  1231. furi_string_cat_str(ns, "0");
  1232. furi_string_cat_str(ns, Edit_pos);
  1233. furi_string_free(fs);
  1234. Log[view_Batch] = ns;
  1235. Edit_pos = (char*)furi_string_get_cstr(ns) + len;
  1236. }
  1237. }
  1238. } else if(what_doing == 0) {
  1239. if(setup_cursor == 0) { // open file
  1240. file_stream_close(file_stream);
  1241. if(select_settings_file()) {
  1242. uint8_t err = load_settings_file();
  1243. if(err) snprintf(file_name, sizeof(file_name), "LOAD ERROR #%d", err);
  1244. }
  1245. } else if(setup_cursor == 1) { // change address
  1246. char *ebuf = (char*)payload;
  1247. ebuf[0] = '\0';
  1248. add_to_str_hex_bytes(ebuf, addr, addr_len);
  1249. Edit_hex = true;
  1250. Edit_pos = ebuf + strlen(ebuf) - 1;
  1251. Edit_start = ebuf;
  1252. Edit = 1;
  1253. NRF_INITED = false;
  1254. } else if(setup_cursor == 2) { // change channel
  1255. char *ebuf = (char*)payload;
  1256. snprintf(ebuf, sizeof(payload), "%d", NRF_channel);
  1257. Edit_hex = false;
  1258. Edit_pos = ebuf + strlen(ebuf) - 1;
  1259. Edit_start = ebuf;
  1260. Edit = 1;
  1261. NRF_INITED = false;
  1262. }
  1263. } else if(what_doing == 1) {
  1264. if(rw_type == rwt_read_batch) {
  1265. if(ReadBatch_cmd_Total) {
  1266. ERR = 0;
  1267. Run_ReadBatch_cmd(ReadBatch_cmd[view_cmd[rwt_read_batch]]);
  1268. view_x = 0;
  1269. view_Batch = 0;
  1270. what_doing = 2;
  1271. }
  1272. } else if(rw_type == rwt_read_cmd) {
  1273. if(Read_cmd_Total) {
  1274. ERR = 0;
  1275. free_Log();
  1276. Run_Read_cmd(Read_cmd[view_cmd[rwt_read_cmd]]);
  1277. view_x = 0;
  1278. what_doing = 2;
  1279. }
  1280. } else if(rw_type == rwt_write_batch) {
  1281. if(WriteBatch_cmd_Total) {
  1282. Prepare_Write_cmd(WriteBatch_cmd[view_cmd[rwt_write_batch]]);
  1283. send_status = sst_none;
  1284. Edited = false;
  1285. view_x = 0;
  1286. view_Batch = 0;
  1287. what_doing = 2;
  1288. }
  1289. }
  1290. } else if(what_doing == 2) {
  1291. if(Log_Total) {
  1292. if(rw_type == rwt_read_batch) {
  1293. ask_question = ask_save_batch;
  1294. ask_question_answer = 0;
  1295. } else if(rw_type == rwt_write_batch) {
  1296. if(!Edit) {
  1297. Edit = 1;
  1298. Edited = true;
  1299. Edit_hex = 0;
  1300. char *s = (char*)furi_string_get_cstr(Log[view_Batch]);
  1301. char *p = strchr(s, '=');
  1302. if(p) {
  1303. p++;
  1304. if(*p == '{') p++; // array
  1305. if(*(p + 1) == 'x') {
  1306. p += 2;
  1307. Edit_hex = 1; // hex
  1308. }
  1309. Edit_start = Edit_pos = p;
  1310. } else Edit = 0;
  1311. }
  1312. }
  1313. }
  1314. }
  1315. } else if(event.input.type == InputTypeLong) {
  1316. if(Edit) { // delete
  1317. if(what_doing == 0) {
  1318. if(strlen(Edit_start) > 1) {
  1319. memmove(Edit_pos, Edit_pos + 1, strlen(Edit_pos) + 1);
  1320. if(*Edit_pos == '\0') Edit_pos--;
  1321. }
  1322. } else {
  1323. FuriString *fs = Log[view_Batch];
  1324. if(is_digit(Edit_pos + 1, Edit_hex) || (Edit_pos > Edit_start && is_digit(Edit_pos - 1, Edit_hex))) {
  1325. memmove(Edit_pos, Edit_pos + 1, strlen(Edit_pos));
  1326. furi_string_left(fs, furi_string_size(fs) - 1);
  1327. }
  1328. }
  1329. } else if(what_doing == 2 && Log_Total) {
  1330. if(rw_type == rwt_write_batch) {
  1331. ask_question = ask_write_batch;
  1332. ask_question_answer = 0;
  1333. } else if(rw_type == rwt_read_batch) {
  1334. ask_question = ask_save_batch;
  1335. ask_question_answer = 0;
  1336. }
  1337. }
  1338. }
  1339. break;
  1340. case InputKeyBack:
  1341. if(event.input.type == InputTypeLong) {
  1342. if(what_doing == 2 && Edited) {
  1343. if(!ask_question) ask_question_answer = 1;
  1344. ask_question = ask_exit;
  1345. } else processing = false;
  1346. } else if(event.input.type == InputTypeShort) {
  1347. if(ask_question) ask_question = 0;
  1348. else if(Edit) {
  1349. if(what_doing == 0) {
  1350. if(setup_cursor == 1) {
  1351. addr_len = ConvertHexToArray((char*)payload, addr, 5);
  1352. } else if(setup_cursor == 2) {
  1353. NRF_channel = str_to_int((char*)payload);
  1354. if(NRF_channel > MAX_CHANNEL) NRF_channel = MAX_CHANNEL;
  1355. }
  1356. }
  1357. Edit = 0;
  1358. } else {
  1359. if(what_doing == 2 && Edited) {
  1360. ask_question = ask_return;
  1361. ask_question_answer = 1;
  1362. } else if(what_doing != 0) {
  1363. if(what_doing) what_doing--;
  1364. if(what_doing == 0) rw_type = rwt_read_batch;
  1365. if(what_doing <= 1) view_x = 0;
  1366. ERR = 0;
  1367. send_status = sst_none;
  1368. }
  1369. }
  1370. }
  1371. break;
  1372. default:
  1373. break;
  1374. }
  1375. }
  1376. }
  1377. view_port_update(APP->view_port);
  1378. release_mutex(&state_mutex, plugin_state);
  1379. }
  1380. nrf24_set_idle(nrf24_HANDLE);
  1381. nrf24_deinit();
  1382. view_port_enabled_set(APP->view_port, false);
  1383. gui_remove_view_port(APP->gui, APP->view_port);
  1384. furi_record_close(RECORD_GUI);
  1385. furi_record_close(RECORD_NOTIFICATION);
  1386. furi_record_close(RECORD_STORAGE);
  1387. if(file_stream) {
  1388. file_stream_close(file_stream);
  1389. stream_free(file_stream);
  1390. }
  1391. view_port_free(APP->view_port);
  1392. furi_message_queue_free(APP->event_queue);
  1393. free_store();
  1394. furi_timer_stop(work_timer);
  1395. furi_timer_free(work_timer);
  1396. free(APP->plugin_state);
  1397. free(APP);
  1398. return 0;
  1399. }