nrf24batch.c 47 KB

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