nrf24batch.c 80 KB

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