nrf24batch.c 79 KB

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