ducky_script.c 34 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936
  1. #include "../bad_kb_app_i.h"
  2. #include <furi.h>
  3. #include <furi_hal.h>
  4. #include <gui/gui.h>
  5. #include <input/input.h>
  6. #include <lib/toolbox/args.h>
  7. #include <furi_hal_usb_hid.h>
  8. #include "ble_hid.h"
  9. #include <storage/storage.h>
  10. #include "ducky_script.h"
  11. #include "ducky_script_i.h"
  12. #include <dolphin/dolphin.h>
  13. #include <toolbox/hex.h>
  14. #define TAG "BadKb"
  15. #define WORKER_TAG TAG "Worker"
  16. #define BADKB_ASCII_TO_KEY(script, x) \
  17. (((uint8_t)x < 128) ? (script->layout[(uint8_t)x]) : HID_KEYBOARD_NONE)
  18. // Delays for waiting between HID key press and key release
  19. const uint8_t bt_hid_delays[LevelRssiNum] = {
  20. 60, // LevelRssi122_100
  21. 55, // LevelRssi99_80
  22. 50, // LevelRssi79_60
  23. 47, // LevelRssi59_40
  24. 34, // LevelRssi39_0
  25. };
  26. uint8_t bt_timeout = 0;
  27. static LevelRssiRange bt_remote_rssi_range(Bt* bt) {
  28. uint8_t rssi;
  29. if(!bt_remote_rssi(bt, &rssi)) return LevelRssiError;
  30. if(rssi <= 39)
  31. return LevelRssi39_0;
  32. else if(rssi <= 59)
  33. return LevelRssi59_40;
  34. else if(rssi <= 79)
  35. return LevelRssi79_60;
  36. else if(rssi <= 99)
  37. return LevelRssi99_80;
  38. else if(rssi <= 122)
  39. return LevelRssi122_100;
  40. return LevelRssiError;
  41. }
  42. static inline void update_bt_timeout(Bt* bt) {
  43. LevelRssiRange r = bt_remote_rssi_range(bt);
  44. if(r < LevelRssiNum) {
  45. bt_timeout = bt_hid_delays[r];
  46. FURI_LOG_D(WORKER_TAG, "BLE Key timeout : %u", bt_timeout);
  47. }
  48. }
  49. static const char ducky_cmd_id[] = {"ID"};
  50. static const char ducky_cmd_bt_id[] = {"BT_ID"};
  51. static const uint8_t numpad_keys[10] = {
  52. HID_KEYPAD_0,
  53. HID_KEYPAD_1,
  54. HID_KEYPAD_2,
  55. HID_KEYPAD_3,
  56. HID_KEYPAD_4,
  57. HID_KEYPAD_5,
  58. HID_KEYPAD_6,
  59. HID_KEYPAD_7,
  60. HID_KEYPAD_8,
  61. HID_KEYPAD_9,
  62. };
  63. uint32_t ducky_get_command_len(const char* line) {
  64. uint32_t len = strlen(line);
  65. for(uint32_t i = 0; i < len; i++) {
  66. if(line[i] == ' ') return i;
  67. }
  68. return 0;
  69. }
  70. bool ducky_is_line_end(const char chr) {
  71. return ((chr == ' ') || (chr == '\0') || (chr == '\r') || (chr == '\n'));
  72. }
  73. uint16_t ducky_get_keycode(BadKbScript* bad_kb, const char* param, bool accept_chars) {
  74. uint16_t keycode = ducky_get_keycode_by_name(param);
  75. if(keycode != HID_KEYBOARD_NONE) {
  76. return keycode;
  77. }
  78. if((accept_chars) && (strlen(param) > 0)) {
  79. return (BADKB_ASCII_TO_KEY(bad_kb, param[0]) & 0xFF);
  80. }
  81. return 0;
  82. }
  83. bool ducky_get_number(const char* param, uint32_t* val) {
  84. uint32_t value = 0;
  85. if(sscanf(param, "%lu", &value) == 1) {
  86. *val = value;
  87. return true;
  88. }
  89. return false;
  90. }
  91. uint8_t furi_hal_bt_hid_get_led_state() {
  92. // FIXME
  93. return 0;
  94. }
  95. void ducky_numlock_on(BadKbScript* bad_kb) {
  96. if(bad_kb->bt) {
  97. if((furi_hal_bt_hid_get_led_state() & HID_KB_LED_NUM) == 0) {
  98. ble_profile_hid_kb_press(bad_kb->app->ble_hid, HID_KEYBOARD_LOCK_NUM_LOCK);
  99. furi_delay_ms(bt_timeout);
  100. ble_profile_hid_kb_release(bad_kb->app->ble_hid, HID_KEYBOARD_LOCK_NUM_LOCK);
  101. }
  102. } else {
  103. if((furi_hal_hid_get_led_state() & HID_KB_LED_NUM) == 0) {
  104. furi_hal_hid_kb_press(HID_KEYBOARD_LOCK_NUM_LOCK);
  105. furi_hal_hid_kb_release(HID_KEYBOARD_LOCK_NUM_LOCK);
  106. }
  107. }
  108. }
  109. bool ducky_numpad_press(BadKbScript* bad_kb, const char num) {
  110. if((num < '0') || (num > '9')) return false;
  111. uint16_t key = numpad_keys[num - '0'];
  112. if(bad_kb->bt) {
  113. ble_profile_hid_kb_press(bad_kb->app->ble_hid, key);
  114. furi_delay_ms(bt_timeout);
  115. ble_profile_hid_kb_release(bad_kb->app->ble_hid, key);
  116. } else {
  117. furi_hal_hid_kb_press(key);
  118. furi_hal_hid_kb_release(key);
  119. }
  120. return true;
  121. }
  122. bool ducky_altchar(BadKbScript* bad_kb, const char* charcode) {
  123. uint8_t i = 0;
  124. bool state = false;
  125. if(bad_kb->bt) {
  126. ble_profile_hid_kb_press(bad_kb->app->ble_hid, KEY_MOD_LEFT_ALT);
  127. } else {
  128. furi_hal_hid_kb_press(KEY_MOD_LEFT_ALT);
  129. }
  130. while(!ducky_is_line_end(charcode[i])) {
  131. state = ducky_numpad_press(bad_kb, charcode[i]);
  132. if(state == false) break;
  133. i++;
  134. }
  135. if(bad_kb->bt) {
  136. ble_profile_hid_kb_release(bad_kb->app->ble_hid, KEY_MOD_LEFT_ALT);
  137. } else {
  138. furi_hal_hid_kb_release(KEY_MOD_LEFT_ALT);
  139. }
  140. return state;
  141. }
  142. bool ducky_altstring(BadKbScript* bad_kb, const char* param) {
  143. uint32_t i = 0;
  144. bool state = false;
  145. while(param[i] != '\0') {
  146. if((param[i] < ' ') || (param[i] > '~')) {
  147. i++;
  148. continue; // Skip non-printable chars
  149. }
  150. char temp_str[4];
  151. snprintf(temp_str, 4, "%u", param[i]);
  152. state = ducky_altchar(bad_kb, temp_str);
  153. if(state == false) break;
  154. i++;
  155. }
  156. return state;
  157. }
  158. int32_t ducky_error(BadKbScript* bad_kb, const char* text, ...) {
  159. va_list args;
  160. va_start(args, text);
  161. vsnprintf(bad_kb->st.error, sizeof(bad_kb->st.error), text, args);
  162. va_end(args);
  163. return SCRIPT_STATE_ERROR;
  164. }
  165. bool ducky_string(BadKbScript* bad_kb, const char* param) {
  166. uint32_t i = 0;
  167. while(param[i] != '\0') {
  168. if(param[i] != '\n') {
  169. uint16_t keycode = BADKB_ASCII_TO_KEY(bad_kb, param[i]);
  170. if(keycode != HID_KEYBOARD_NONE) {
  171. if(bad_kb->bt) {
  172. ble_profile_hid_kb_press(bad_kb->app->ble_hid, keycode);
  173. furi_delay_ms(bt_timeout);
  174. ble_profile_hid_kb_release(bad_kb->app->ble_hid, keycode);
  175. } else {
  176. furi_hal_hid_kb_press(keycode);
  177. furi_hal_hid_kb_release(keycode);
  178. }
  179. }
  180. } else {
  181. if(bad_kb->bt) {
  182. ble_profile_hid_kb_press(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
  183. furi_delay_ms(bt_timeout);
  184. ble_profile_hid_kb_release(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
  185. } else {
  186. furi_hal_hid_kb_press(HID_KEYBOARD_RETURN);
  187. furi_hal_hid_kb_release(HID_KEYBOARD_RETURN);
  188. }
  189. }
  190. i++;
  191. }
  192. bad_kb->stringdelay = 0;
  193. return true;
  194. }
  195. static bool ducky_string_next(BadKbScript* bad_kb) {
  196. if(bad_kb->string_print_pos >= furi_string_size(bad_kb->string_print)) {
  197. return true;
  198. }
  199. char print_char = furi_string_get_char(bad_kb->string_print, bad_kb->string_print_pos);
  200. if(print_char != '\n') {
  201. uint16_t keycode = BADKB_ASCII_TO_KEY(bad_kb, print_char);
  202. if(keycode != HID_KEYBOARD_NONE) {
  203. if(bad_kb->bt) {
  204. ble_profile_hid_kb_press(bad_kb->app->ble_hid, keycode);
  205. furi_delay_ms(bt_timeout);
  206. ble_profile_hid_kb_release(bad_kb->app->ble_hid, keycode);
  207. } else {
  208. furi_hal_hid_kb_press(keycode);
  209. furi_hal_hid_kb_release(keycode);
  210. }
  211. }
  212. } else {
  213. if(bad_kb->bt) {
  214. ble_profile_hid_kb_press(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
  215. furi_delay_ms(bt_timeout);
  216. ble_profile_hid_kb_release(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
  217. } else {
  218. furi_hal_hid_kb_press(HID_KEYBOARD_RETURN);
  219. furi_hal_hid_kb_release(HID_KEYBOARD_RETURN);
  220. }
  221. }
  222. bad_kb->string_print_pos++;
  223. return false;
  224. }
  225. static int32_t ducky_parse_line(BadKbScript* bad_kb, FuriString* line) {
  226. uint32_t line_len = furi_string_size(line);
  227. const char* line_tmp = furi_string_get_cstr(line);
  228. if(line_len == 0) {
  229. return SCRIPT_STATE_NEXT_LINE; // Skip empty lines
  230. }
  231. FURI_LOG_D(WORKER_TAG, "line:%s", line_tmp);
  232. // Ducky Lang Functions
  233. int32_t cmd_result = ducky_execute_cmd(bad_kb, line_tmp);
  234. if(cmd_result != SCRIPT_STATE_CMD_UNKNOWN) {
  235. return cmd_result;
  236. }
  237. // Special keys + modifiers
  238. uint16_t key = ducky_get_keycode(bad_kb, line_tmp, false);
  239. if(key == HID_KEYBOARD_NONE) {
  240. return ducky_error(bad_kb, "No keycode defined for %s", line_tmp);
  241. }
  242. if((key & 0xFF00) != 0) {
  243. // It's a modifier key
  244. uint32_t offset = ducky_get_command_len(line_tmp) + 1;
  245. // ducky_get_command_len() returns 0 without space, so check for != 1
  246. if(offset != 1 && line_len > offset) {
  247. // It's also a key combination
  248. key |= ducky_get_keycode(bad_kb, line_tmp + offset, true);
  249. }
  250. }
  251. if(bad_kb->bt) {
  252. ble_profile_hid_kb_press(bad_kb->app->ble_hid, key);
  253. furi_delay_ms(bt_timeout);
  254. ble_profile_hid_kb_release(bad_kb->app->ble_hid, key);
  255. } else {
  256. furi_hal_hid_kb_press(key);
  257. furi_hal_hid_kb_release(key);
  258. }
  259. return 0;
  260. }
  261. static bool ducky_set_usb_id(BadKbScript* bad_kb, const char* line) {
  262. FuriHalUsbHidConfig* cfg = &bad_kb->app->id_config.usb;
  263. if(sscanf(line, "%lX:%lX", &cfg->vid, &cfg->pid) == 2) {
  264. cfg->manuf[0] = '\0';
  265. cfg->product[0] = '\0';
  266. uint8_t id_len = ducky_get_command_len(line);
  267. if(!ducky_is_line_end(line[id_len + 1])) {
  268. sscanf(&line[id_len + 1], "%31[^\r\n:]:%31[^\r\n]", cfg->manuf, cfg->product);
  269. }
  270. FURI_LOG_D(
  271. WORKER_TAG,
  272. "set usb id: %04lX:%04lX mfr:%s product:%s",
  273. cfg->vid,
  274. cfg->pid,
  275. cfg->manuf,
  276. cfg->product);
  277. return true;
  278. }
  279. return false;
  280. }
  281. static bool ducky_set_bt_id(BadKbScript* bad_kb, const char* line) {
  282. BadKbConfig* cfg = &bad_kb->app->id_config;
  283. size_t line_len = strlen(line);
  284. size_t mac_len = sizeof(cfg->ble.mac) * 3; // 2 text chars + separator per byte
  285. if(line_len < mac_len + 1) return false; // MAC + at least 1 char for name
  286. for(size_t i = 0; i < sizeof(cfg->ble.mac); i++) {
  287. char a = line[i * 3];
  288. char b = line[i * 3 + 1];
  289. if((a < 'A' && a > 'F') || (a < '0' && a > '9') || (b < 'A' && b > 'F') ||
  290. (b < '0' && b > '9') || !hex_char_to_uint8(a, b, &cfg->ble.mac[i])) {
  291. return false;
  292. }
  293. }
  294. furi_hal_bt_reverse_mac_addr(cfg->ble.mac);
  295. strlcpy(cfg->ble.name, line + mac_len, sizeof(cfg->ble.name));
  296. FURI_LOG_D(WORKER_TAG, "set bt id: %s", line);
  297. return true;
  298. }
  299. static void ducky_script_preload(BadKbScript* bad_kb, File* script_file) {
  300. BadKbApp* app = bad_kb->app;
  301. uint8_t ret = 0;
  302. uint32_t line_len = 0;
  303. furi_string_reset(bad_kb->line);
  304. do {
  305. ret = storage_file_read(script_file, bad_kb->file_buf, FILE_BUFFER_LEN);
  306. for(uint16_t i = 0; i < ret; i++) {
  307. if(bad_kb->file_buf[i] == '\n' && line_len > 0) {
  308. bad_kb->st.line_nb++;
  309. line_len = 0;
  310. } else {
  311. if(bad_kb->st.line_nb == 0) { // Save first line
  312. furi_string_push_back(bad_kb->line, bad_kb->file_buf[i]);
  313. }
  314. line_len++;
  315. }
  316. }
  317. if(storage_file_eof(script_file)) {
  318. if(line_len > 0) {
  319. bad_kb->st.line_nb++;
  320. break;
  321. }
  322. }
  323. } while(ret > 0);
  324. // Looking for ID or BT_ID command at first line
  325. const char* line_tmp = furi_string_get_cstr(bad_kb->line);
  326. app->set_usb_id = false;
  327. app->set_bt_id = false;
  328. app->has_usb_id = strncmp(line_tmp, ducky_cmd_id, strlen(ducky_cmd_id)) == 0;
  329. app->has_bt_id = strncmp(line_tmp, ducky_cmd_bt_id, strlen(ducky_cmd_bt_id)) == 0;
  330. // Auto-switch to mode chosen with ID/BT_ID, can override manually in config screen
  331. if(app->has_usb_id) {
  332. app->is_bt = false;
  333. app->set_usb_id = ducky_set_usb_id(bad_kb, &line_tmp[strlen(ducky_cmd_id) + 1]);
  334. } else if(app->has_bt_id) {
  335. app->is_bt = true;
  336. app->set_bt_id = ducky_set_bt_id(bad_kb, &line_tmp[strlen(ducky_cmd_bt_id) + 1]);
  337. }
  338. storage_file_seek(script_file, 0, true);
  339. furi_string_reset(bad_kb->line);
  340. }
  341. static int32_t ducky_script_execute_next(BadKbScript* bad_kb, File* script_file) {
  342. int32_t delay_val = 0;
  343. if(bad_kb->repeat_cnt > 0) {
  344. bad_kb->repeat_cnt--;
  345. delay_val = ducky_parse_line(bad_kb, bad_kb->line_prev);
  346. if(delay_val == SCRIPT_STATE_NEXT_LINE) { // Empty line
  347. return 0;
  348. } else if(delay_val == SCRIPT_STATE_STRING_START) { // Print string with delays
  349. return delay_val;
  350. } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // wait for button
  351. return delay_val;
  352. } else if(delay_val < 0) { // Script error
  353. bad_kb->st.error_line = bad_kb->st.line_cur - 1;
  354. FURI_LOG_E(WORKER_TAG, "Unknown command at line %zu", bad_kb->st.line_cur - 1U);
  355. return SCRIPT_STATE_ERROR;
  356. } else {
  357. return (delay_val + bad_kb->defdelay);
  358. }
  359. }
  360. furi_string_set(bad_kb->line_prev, bad_kb->line);
  361. furi_string_reset(bad_kb->line);
  362. while(1) {
  363. if(bad_kb->buf_len == 0) {
  364. bad_kb->buf_len = storage_file_read(script_file, bad_kb->file_buf, FILE_BUFFER_LEN);
  365. if(storage_file_eof(script_file)) {
  366. if((bad_kb->buf_len < FILE_BUFFER_LEN) && (bad_kb->file_end == false)) {
  367. bad_kb->file_buf[bad_kb->buf_len] = '\n';
  368. bad_kb->buf_len++;
  369. bad_kb->file_end = true;
  370. }
  371. }
  372. bad_kb->buf_start = 0;
  373. if(bad_kb->buf_len == 0) return SCRIPT_STATE_END;
  374. }
  375. for(uint8_t i = bad_kb->buf_start; i < (bad_kb->buf_start + bad_kb->buf_len); i++) {
  376. if(bad_kb->file_buf[i] == '\n' && furi_string_size(bad_kb->line) > 0) {
  377. bad_kb->st.line_cur++;
  378. bad_kb->buf_len = bad_kb->buf_len + bad_kb->buf_start - (i + 1);
  379. bad_kb->buf_start = i + 1;
  380. furi_string_trim(bad_kb->line);
  381. delay_val = ducky_parse_line(bad_kb, bad_kb->line);
  382. if(delay_val == SCRIPT_STATE_NEXT_LINE) { // Empty line
  383. return 0;
  384. } else if(delay_val == SCRIPT_STATE_STRING_START) { // Print string with delays
  385. return delay_val;
  386. } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // wait for button
  387. return delay_val;
  388. } else if(delay_val < 0) {
  389. bad_kb->st.error_line = bad_kb->st.line_cur;
  390. FURI_LOG_E(WORKER_TAG, "Unknown command at line %zu", bad_kb->st.line_cur);
  391. return SCRIPT_STATE_ERROR;
  392. } else {
  393. return (delay_val + bad_kb->defdelay);
  394. }
  395. } else {
  396. furi_string_push_back(bad_kb->line, bad_kb->file_buf[i]);
  397. }
  398. }
  399. bad_kb->buf_len = 0;
  400. if(bad_kb->file_end) return SCRIPT_STATE_END;
  401. }
  402. return 0;
  403. }
  404. void bad_kb_bt_hid_state_callback(BtStatus status, void* context) {
  405. furi_assert(context);
  406. BadKbScript* bad_kb = context;
  407. bool state = (status == BtStatusConnected);
  408. if(state == true) {
  409. LevelRssiRange r = bt_remote_rssi_range(bad_kb->bt);
  410. if(r != LevelRssiError) {
  411. bt_timeout = bt_hid_delays[r];
  412. }
  413. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtConnect);
  414. } else {
  415. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtDisconnect);
  416. }
  417. }
  418. void bad_kb_usb_hid_state_callback(bool state, void* context) {
  419. furi_assert(context);
  420. BadKbScript* bad_kb = context;
  421. if(state == true) {
  422. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtConnect);
  423. } else {
  424. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtDisconnect);
  425. }
  426. }
  427. static uint32_t bad_kb_flags_get(uint32_t flags_mask, uint32_t timeout) {
  428. uint32_t flags = furi_thread_flags_get();
  429. furi_check((flags & FuriFlagError) == 0);
  430. if(flags == 0) {
  431. flags = furi_thread_flags_wait(flags_mask, FuriFlagWaitAny, timeout);
  432. furi_check(((flags & FuriFlagError) == 0) || (flags == (unsigned)FuriFlagErrorTimeout));
  433. } else {
  434. uint32_t state = furi_thread_flags_clear(flags);
  435. furi_check((state & FuriFlagError) == 0);
  436. }
  437. return flags;
  438. }
  439. static int32_t bad_kb_worker(void* context) {
  440. BadKbScript* bad_kb = context;
  441. BadKbWorkerState worker_state = BadKbStateInit;
  442. BadKbWorkerState pause_state = BadKbStateRunning;
  443. int32_t delay_val = 0;
  444. FURI_LOG_I(WORKER_TAG, "Init");
  445. File* script_file = storage_file_alloc(furi_record_open(RECORD_STORAGE));
  446. bad_kb->line = furi_string_alloc();
  447. bad_kb->line_prev = furi_string_alloc();
  448. bad_kb->string_print = furi_string_alloc();
  449. bad_kb->st.elapsed = 0;
  450. while(1) {
  451. uint32_t start = furi_get_tick();
  452. if(worker_state == BadKbStateInit) { // State: initialization
  453. start = 0;
  454. FURI_LOG_D(WORKER_TAG, "init start");
  455. if(storage_file_open(
  456. script_file,
  457. furi_string_get_cstr(bad_kb->file_path),
  458. FSAM_READ,
  459. FSOM_OPEN_EXISTING)) {
  460. ducky_script_preload(bad_kb, script_file);
  461. if(bad_kb->st.line_nb > 0) {
  462. bad_kb_config_refresh(bad_kb->app);
  463. worker_state = BadKbStateNotConnected; // Refresh will set connected flag
  464. } else {
  465. worker_state = BadKbStateScriptError; // Script preload error
  466. }
  467. } else {
  468. FURI_LOG_E(WORKER_TAG, "File open error");
  469. worker_state = BadKbStateFileError; // File open error
  470. }
  471. bad_kb->st.state = worker_state;
  472. FURI_LOG_D(WORKER_TAG, "init done");
  473. } else if(worker_state == BadKbStateNotConnected) { // State: Not connected
  474. start = 0;
  475. FURI_LOG_D(WORKER_TAG, "not connected wait");
  476. uint32_t flags = bad_kb_flags_get(
  477. WorkerEvtEnd | WorkerEvtConnect | WorkerEvtDisconnect | WorkerEvtStartStop,
  478. FuriWaitForever);
  479. FURI_LOG_D(WORKER_TAG, "not connected flags: %lu", flags);
  480. if(flags & WorkerEvtEnd) {
  481. break;
  482. } else if(flags & WorkerEvtConnect) {
  483. worker_state = BadKbStateIdle; // Ready to run
  484. } else if(flags & WorkerEvtStartStop) {
  485. worker_state = BadKbStateWillRun; // Will run when connected
  486. }
  487. bad_kb->st.state = worker_state;
  488. } else if(worker_state == BadKbStateIdle) { // State: ready to start
  489. start = 0;
  490. FURI_LOG_D(WORKER_TAG, "idle wait");
  491. uint32_t flags = bad_kb_flags_get(
  492. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtConnect | WorkerEvtDisconnect,
  493. FuriWaitForever);
  494. FURI_LOG_D(WORKER_TAG, "idle flags: %lu", flags);
  495. if(flags & WorkerEvtEnd) {
  496. break;
  497. } else if(flags & WorkerEvtStartStop) { // Start executing script
  498. //dolphin_deed(DolphinDeedBadKbPlayScript);
  499. delay_val = 0;
  500. bad_kb->buf_len = 0;
  501. bad_kb->st.line_cur = 0;
  502. bad_kb->defdelay = 0;
  503. bad_kb->stringdelay = 0;
  504. bad_kb->repeat_cnt = 0;
  505. bad_kb->key_hold_nb = 0;
  506. bad_kb->file_end = false;
  507. storage_file_seek(script_file, 0, true);
  508. bad_kb_script_set_keyboard_layout(bad_kb, bad_kb->keyboard_layout);
  509. worker_state = BadKbStateRunning;
  510. bad_kb->st.elapsed = 0;
  511. } else if(flags & WorkerEvtDisconnect) {
  512. worker_state = BadKbStateNotConnected; // Disconnected
  513. }
  514. bad_kb->st.state = worker_state;
  515. } else if(worker_state == BadKbStateWillRun) { // State: start on connection
  516. start = 0;
  517. FURI_LOG_D(WORKER_TAG, "will run wait");
  518. uint32_t flags = bad_kb_flags_get(
  519. WorkerEvtEnd | WorkerEvtConnect | WorkerEvtDisconnect | WorkerEvtStartStop,
  520. FuriWaitForever);
  521. FURI_LOG_D(WORKER_TAG, "will run flags: %lu", flags);
  522. if(flags & WorkerEvtEnd) {
  523. break;
  524. } else if(flags & WorkerEvtConnect) { // Start executing script
  525. //dolphin_deed(DolphinDeedBadKbPlayScript);
  526. delay_val = 0;
  527. bad_kb->buf_len = 0;
  528. bad_kb->st.line_cur = 0;
  529. bad_kb->defdelay = 0;
  530. bad_kb->stringdelay = 0;
  531. bad_kb->repeat_cnt = 0;
  532. bad_kb->file_end = false;
  533. storage_file_seek(script_file, 0, true);
  534. // extra time for PC to recognize Flipper as keyboard
  535. flags = furi_thread_flags_wait(
  536. WorkerEvtEnd | WorkerEvtDisconnect | WorkerEvtStartStop,
  537. FuriFlagWaitAny | FuriFlagNoClear,
  538. bad_kb->bt ? 3000 : 1500);
  539. if(flags == (unsigned)FuriFlagErrorTimeout) {
  540. // If nothing happened - start script execution
  541. worker_state = BadKbStateRunning;
  542. bad_kb->st.elapsed = 0;
  543. } else if(flags & WorkerEvtStartStop) {
  544. worker_state = BadKbStateIdle;
  545. furi_thread_flags_clear(WorkerEvtStartStop);
  546. }
  547. if(bad_kb->bt) {
  548. update_bt_timeout(bad_kb->bt);
  549. }
  550. bad_kb_script_set_keyboard_layout(bad_kb, bad_kb->keyboard_layout);
  551. } else if(flags & WorkerEvtStartStop) { // Cancel scheduled execution
  552. worker_state = BadKbStateNotConnected;
  553. }
  554. bad_kb->st.state = worker_state;
  555. } else if(worker_state == BadKbStateRunning) { // State: running
  556. FURI_LOG_D(WORKER_TAG, "running");
  557. uint16_t delay_cur = (delay_val > 100) ? (100) : (delay_val);
  558. uint32_t flags = furi_thread_flags_wait(
  559. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  560. WorkerEvtDisconnect,
  561. FuriFlagWaitAny,
  562. delay_cur);
  563. FURI_LOG_D(WORKER_TAG, "running flags: %lu", flags);
  564. delay_val -= delay_cur;
  565. if(!(flags & FuriFlagError)) {
  566. if(flags & WorkerEvtEnd) {
  567. break;
  568. } else if(flags & WorkerEvtStartStop) {
  569. worker_state = BadKbStateIdle; // Stop executing script
  570. if(bad_kb->bt) {
  571. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  572. } else {
  573. furi_hal_hid_kb_release_all();
  574. }
  575. } else if(flags & WorkerEvtDisconnect) {
  576. worker_state = BadKbStateNotConnected; // Disconnected
  577. if(bad_kb->bt) {
  578. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  579. } else {
  580. furi_hal_hid_kb_release_all();
  581. }
  582. } else if(flags & WorkerEvtPauseResume) {
  583. pause_state = BadKbStateRunning;
  584. worker_state = BadKbStatePaused; // Pause
  585. }
  586. bad_kb->st.state = worker_state;
  587. bad_kb->st.elapsed += (furi_get_tick() - start);
  588. continue;
  589. } else if(
  590. (flags == (unsigned)FuriFlagErrorTimeout) ||
  591. (flags == (unsigned)FuriFlagErrorResource)) {
  592. if(delay_val > 0) {
  593. bad_kb->st.delay_remain--;
  594. bad_kb->st.elapsed += (furi_get_tick() - start);
  595. continue;
  596. }
  597. bad_kb->st.state = BadKbStateRunning;
  598. delay_val = ducky_script_execute_next(bad_kb, script_file);
  599. if(delay_val == SCRIPT_STATE_ERROR) { // Script error
  600. delay_val = 0;
  601. worker_state = BadKbStateScriptError;
  602. bad_kb->st.state = worker_state;
  603. if(bad_kb->bt) {
  604. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  605. } else {
  606. furi_hal_hid_kb_release_all();
  607. }
  608. } else if(delay_val == SCRIPT_STATE_END) { // End of script
  609. delay_val = 0;
  610. worker_state = BadKbStateIdle;
  611. bad_kb->st.state = BadKbStateDone;
  612. if(bad_kb->bt) {
  613. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  614. } else {
  615. furi_hal_hid_kb_release_all();
  616. }
  617. bad_kb->st.elapsed += (furi_get_tick() - start);
  618. continue;
  619. } else if(delay_val == SCRIPT_STATE_STRING_START) { // Start printing string with delays
  620. delay_val = bad_kb->defdelay;
  621. bad_kb->string_print_pos = 0;
  622. worker_state = BadKbStateStringDelay;
  623. } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // set state to wait for user input
  624. worker_state = BadKbStateWaitForBtn;
  625. bad_kb->st.state = BadKbStateWaitForBtn; // Show long delays
  626. } else if(delay_val > 100) {
  627. bad_kb->st.state = BadKbStateDelay; // Show long delays
  628. bad_kb->st.delay_remain = delay_val / 100;
  629. }
  630. } else {
  631. furi_check((flags & FuriFlagError) == 0);
  632. }
  633. } else if(worker_state == BadKbStateWaitForBtn) { // State: Wait for button Press
  634. start = 0;
  635. FURI_LOG_D(WORKER_TAG, "button wait");
  636. uint32_t flags = bad_kb_flags_get(
  637. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  638. WorkerEvtDisconnect,
  639. FuriWaitForever);
  640. FURI_LOG_D(WORKER_TAG, "button flags: %lu", flags);
  641. if(!(flags & FuriFlagError)) {
  642. if(flags & WorkerEvtEnd) {
  643. break;
  644. } else if(flags & WorkerEvtStartStop) {
  645. delay_val = 0;
  646. worker_state = BadKbStateRunning;
  647. } else if(flags & WorkerEvtDisconnect) {
  648. worker_state = BadKbStateNotConnected; // Disconnected
  649. if(bad_kb->bt) {
  650. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  651. } else {
  652. furi_hal_hid_kb_release_all();
  653. }
  654. }
  655. bad_kb->st.state = worker_state;
  656. continue;
  657. }
  658. } else if(worker_state == BadKbStatePaused) { // State: Paused
  659. start = 0;
  660. FURI_LOG_D(WORKER_TAG, "paused wait");
  661. uint32_t flags = bad_kb_flags_get(
  662. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  663. WorkerEvtDisconnect,
  664. FuriWaitForever);
  665. FURI_LOG_D(WORKER_TAG, "paused flags: %lu", flags);
  666. if(!(flags & FuriFlagError)) {
  667. if(flags & WorkerEvtEnd) {
  668. break;
  669. } else if(flags & WorkerEvtStartStop) {
  670. worker_state = BadKbStateIdle; // Stop executing script
  671. bad_kb->st.state = worker_state;
  672. if(bad_kb->bt) {
  673. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  674. } else {
  675. furi_hal_hid_kb_release_all();
  676. }
  677. } else if(flags & WorkerEvtDisconnect) {
  678. worker_state = BadKbStateNotConnected; // Disconnected
  679. bad_kb->st.state = worker_state;
  680. if(bad_kb->bt) {
  681. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  682. } else {
  683. furi_hal_hid_kb_release_all();
  684. }
  685. } else if(flags & WorkerEvtPauseResume) {
  686. if(pause_state == BadKbStateRunning) {
  687. if(delay_val > 0) {
  688. bad_kb->st.state = BadKbStateDelay;
  689. bad_kb->st.delay_remain = delay_val / 100;
  690. } else {
  691. bad_kb->st.state = BadKbStateRunning;
  692. delay_val = 0;
  693. }
  694. worker_state = BadKbStateRunning; // Resume
  695. } else if(pause_state == BadKbStateStringDelay) {
  696. bad_kb->st.state = BadKbStateRunning;
  697. worker_state = BadKbStateStringDelay; // Resume
  698. }
  699. }
  700. continue;
  701. }
  702. } else if(worker_state == BadKbStateStringDelay) { // State: print string with delays
  703. FURI_LOG_D(WORKER_TAG, "delay wait");
  704. uint32_t flags = bad_kb_flags_get(
  705. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  706. WorkerEvtDisconnect,
  707. bad_kb->stringdelay);
  708. FURI_LOG_D(WORKER_TAG, "delay flags: %lu", flags);
  709. if(!(flags & FuriFlagError)) {
  710. if(flags & WorkerEvtEnd) {
  711. break;
  712. } else if(flags & WorkerEvtStartStop) {
  713. worker_state = BadKbStateIdle; // Stop executing script
  714. if(bad_kb->bt) {
  715. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  716. } else {
  717. furi_hal_hid_kb_release_all();
  718. }
  719. } else if(flags & WorkerEvtDisconnect) {
  720. worker_state = BadKbStateNotConnected; // Disconnected
  721. if(bad_kb->bt) {
  722. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  723. } else {
  724. furi_hal_hid_kb_release_all();
  725. }
  726. } else if(flags & WorkerEvtPauseResume) {
  727. pause_state = BadKbStateStringDelay;
  728. worker_state = BadKbStatePaused; // Pause
  729. }
  730. bad_kb->st.state = worker_state;
  731. bad_kb->st.elapsed += (furi_get_tick() - start);
  732. continue;
  733. } else if(
  734. (flags == (unsigned)FuriFlagErrorTimeout) ||
  735. (flags == (unsigned)FuriFlagErrorResource)) {
  736. bool string_end = ducky_string_next(bad_kb);
  737. if(string_end) {
  738. bad_kb->stringdelay = 0;
  739. worker_state = BadKbStateRunning;
  740. }
  741. } else {
  742. furi_check((flags & FuriFlagError) == 0);
  743. }
  744. } else if(
  745. (worker_state == BadKbStateFileError) ||
  746. (worker_state == BadKbStateScriptError)) { // State: error
  747. start = 0;
  748. FURI_LOG_D(WORKER_TAG, "error wait");
  749. uint32_t flags =
  750. bad_kb_flags_get(WorkerEvtEnd, FuriWaitForever); // Waiting for exit command
  751. FURI_LOG_D(WORKER_TAG, "error flags: %lu", flags);
  752. if(flags & WorkerEvtEnd) {
  753. break;
  754. }
  755. }
  756. if(bad_kb->bt) {
  757. update_bt_timeout(bad_kb->bt);
  758. }
  759. if(start) {
  760. bad_kb->st.elapsed += (furi_get_tick() - start);
  761. }
  762. }
  763. bt_set_status_changed_callback(bad_kb->app->bt, NULL, NULL);
  764. furi_hal_hid_set_state_callback(NULL, NULL);
  765. storage_file_close(script_file);
  766. storage_file_free(script_file);
  767. furi_string_free(bad_kb->line);
  768. furi_string_free(bad_kb->line_prev);
  769. furi_string_free(bad_kb->string_print);
  770. FURI_LOG_I(WORKER_TAG, "End");
  771. return 0;
  772. }
  773. static void bad_kb_script_set_default_keyboard_layout(BadKbScript* bad_kb) {
  774. furi_assert(bad_kb);
  775. furi_string_set_str(bad_kb->keyboard_layout, "");
  776. memset(bad_kb->layout, HID_KEYBOARD_NONE, sizeof(bad_kb->layout));
  777. memcpy(bad_kb->layout, hid_asciimap, MIN(sizeof(hid_asciimap), sizeof(bad_kb->layout)));
  778. }
  779. BadKbScript* bad_kb_script_open(FuriString* file_path, Bt* bt, BadKbApp* app) {
  780. furi_assert(file_path);
  781. BadKbScript* bad_kb = malloc(sizeof(BadKbScript));
  782. bad_kb->app = app;
  783. bad_kb->file_path = furi_string_alloc();
  784. furi_string_set(bad_kb->file_path, file_path);
  785. bad_kb->keyboard_layout = furi_string_alloc();
  786. bad_kb_script_set_default_keyboard_layout(bad_kb);
  787. bad_kb->st.state = BadKbStateInit;
  788. bad_kb->st.error[0] = '\0';
  789. bad_kb->st.is_bt = !!bt;
  790. bad_kb->bt = bt;
  791. bad_kb->thread = furi_thread_alloc_ex("BadKbWorker", 2048, bad_kb_worker, bad_kb);
  792. furi_thread_start(bad_kb->thread);
  793. return bad_kb;
  794. } //-V773
  795. void bad_kb_script_close(BadKbScript* bad_kb) {
  796. furi_assert(bad_kb);
  797. furi_record_close(RECORD_STORAGE);
  798. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtEnd);
  799. furi_thread_join(bad_kb->thread);
  800. furi_thread_free(bad_kb->thread);
  801. furi_string_free(bad_kb->file_path);
  802. furi_string_free(bad_kb->keyboard_layout);
  803. free(bad_kb);
  804. }
  805. void bad_kb_script_set_keyboard_layout(BadKbScript* bad_kb, FuriString* layout_path) {
  806. furi_assert(bad_kb);
  807. if((bad_kb->st.state == BadKbStateRunning) || (bad_kb->st.state == BadKbStateDelay)) {
  808. // do not update keyboard layout while a script is running
  809. return;
  810. }
  811. File* layout_file = storage_file_alloc(furi_record_open(RECORD_STORAGE));
  812. if(!furi_string_empty(layout_path)) { //-V1051
  813. furi_string_set(bad_kb->keyboard_layout, layout_path);
  814. if(storage_file_open(
  815. layout_file, furi_string_get_cstr(layout_path), FSAM_READ, FSOM_OPEN_EXISTING)) {
  816. uint16_t layout[128];
  817. if(storage_file_read(layout_file, layout, sizeof(layout)) == sizeof(layout)) {
  818. memcpy(bad_kb->layout, layout, sizeof(layout));
  819. }
  820. }
  821. storage_file_close(layout_file);
  822. } else {
  823. bad_kb_script_set_default_keyboard_layout(bad_kb);
  824. }
  825. storage_file_free(layout_file);
  826. }
  827. void bad_kb_script_start_stop(BadKbScript* bad_kb) {
  828. furi_assert(bad_kb);
  829. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtStartStop);
  830. }
  831. void bad_kb_script_pause_resume(BadKbScript* bad_kb) {
  832. furi_assert(bad_kb);
  833. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtPauseResume);
  834. }
  835. BadKbState* bad_kb_script_get_state(BadKbScript* bad_kb) {
  836. furi_assert(bad_kb);
  837. return &(bad_kb->st);
  838. }