nrf24batch.c 58 KB

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