bad_usb_script.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624
  1. #include <furi.h>
  2. #include <furi_hal.h>
  3. #include <gui/gui.h>
  4. #include <input/input.h>
  5. #include <lib/toolbox/args.h>
  6. #include <furi_hal_usb_hid.h>
  7. #include <storage/storage.h>
  8. #include "bad_usb_script.h"
  9. #include <dolphin/dolphin.h>
  10. #define TAG "BadUSB"
  11. #define WORKER_TAG TAG "Worker"
  12. #define FILE_BUFFER_LEN 16
  13. #define SCRIPT_STATE_ERROR (-1)
  14. #define SCRIPT_STATE_END (-2)
  15. #define SCRIPT_STATE_NEXT_LINE (-3)
  16. typedef enum {
  17. WorkerEvtToggle = (1 << 0),
  18. WorkerEvtEnd = (1 << 1),
  19. WorkerEvtConnect = (1 << 2),
  20. WorkerEvtDisconnect = (1 << 3),
  21. } WorkerEvtFlags;
  22. struct BadUsbScript {
  23. FuriHalUsbHidConfig hid_cfg;
  24. BadUsbState st;
  25. string_t file_path;
  26. uint32_t defdelay;
  27. FuriThread* thread;
  28. uint8_t file_buf[FILE_BUFFER_LEN + 1];
  29. uint8_t buf_start;
  30. uint8_t buf_len;
  31. bool file_end;
  32. string_t line;
  33. string_t line_prev;
  34. uint32_t repeat_cnt;
  35. };
  36. typedef struct {
  37. char* name;
  38. uint16_t keycode;
  39. } DuckyKey;
  40. static const DuckyKey ducky_keys[] = {
  41. {"CTRL-ALT", KEY_MOD_LEFT_CTRL | KEY_MOD_LEFT_ALT},
  42. {"CTRL-SHIFT", KEY_MOD_LEFT_CTRL | KEY_MOD_LEFT_SHIFT},
  43. {"ALT-SHIFT", KEY_MOD_LEFT_ALT | KEY_MOD_LEFT_SHIFT},
  44. {"ALT-GUI", KEY_MOD_LEFT_ALT | KEY_MOD_LEFT_GUI},
  45. {"GUI-SHIFT", KEY_MOD_LEFT_GUI | KEY_MOD_LEFT_SHIFT},
  46. {"CTRL", KEY_MOD_LEFT_CTRL},
  47. {"CONTROL", KEY_MOD_LEFT_CTRL},
  48. {"SHIFT", KEY_MOD_LEFT_SHIFT},
  49. {"ALT", KEY_MOD_LEFT_ALT},
  50. {"GUI", KEY_MOD_LEFT_GUI},
  51. {"WINDOWS", KEY_MOD_LEFT_GUI},
  52. {"DOWNARROW", HID_KEYBOARD_DOWN_ARROW},
  53. {"DOWN", HID_KEYBOARD_DOWN_ARROW},
  54. {"LEFTARROW", HID_KEYBOARD_LEFT_ARROW},
  55. {"LEFT", HID_KEYBOARD_LEFT_ARROW},
  56. {"RIGHTARROW", HID_KEYBOARD_RIGHT_ARROW},
  57. {"RIGHT", HID_KEYBOARD_RIGHT_ARROW},
  58. {"UPARROW", HID_KEYBOARD_UP_ARROW},
  59. {"UP", HID_KEYBOARD_UP_ARROW},
  60. {"ENTER", HID_KEYBOARD_RETURN},
  61. {"BREAK", HID_KEYBOARD_PAUSE},
  62. {"PAUSE", HID_KEYBOARD_PAUSE},
  63. {"CAPSLOCK", HID_KEYBOARD_CAPS_LOCK},
  64. {"DELETE", HID_KEYBOARD_DELETE},
  65. {"BACKSPACE", HID_KEYPAD_BACKSPACE},
  66. {"END", HID_KEYBOARD_END},
  67. {"ESC", HID_KEYBOARD_ESCAPE},
  68. {"ESCAPE", HID_KEYBOARD_ESCAPE},
  69. {"HOME", HID_KEYBOARD_HOME},
  70. {"INSERT", HID_KEYBOARD_INSERT},
  71. {"NUMLOCK", HID_KEYPAD_NUMLOCK},
  72. {"PAGEUP", HID_KEYBOARD_PAGE_UP},
  73. {"PAGEDOWN", HID_KEYBOARD_PAGE_DOWN},
  74. {"PRINTSCREEN", HID_KEYBOARD_PRINT_SCREEN},
  75. {"SCROLLOCK", HID_KEYBOARD_SCROLL_LOCK},
  76. {"SPACE", HID_KEYBOARD_SPACEBAR},
  77. {"TAB", HID_KEYBOARD_TAB},
  78. {"MENU", HID_KEYBOARD_APPLICATION},
  79. {"APP", HID_KEYBOARD_APPLICATION},
  80. {"F1", HID_KEYBOARD_F1},
  81. {"F2", HID_KEYBOARD_F2},
  82. {"F3", HID_KEYBOARD_F3},
  83. {"F4", HID_KEYBOARD_F4},
  84. {"F5", HID_KEYBOARD_F5},
  85. {"F6", HID_KEYBOARD_F6},
  86. {"F7", HID_KEYBOARD_F7},
  87. {"F8", HID_KEYBOARD_F8},
  88. {"F9", HID_KEYBOARD_F9},
  89. {"F10", HID_KEYBOARD_F10},
  90. {"F11", HID_KEYBOARD_F11},
  91. {"F12", HID_KEYBOARD_F12},
  92. };
  93. static const char ducky_cmd_comment[] = {"REM"};
  94. static const char ducky_cmd_id[] = {"ID"};
  95. static const char ducky_cmd_delay[] = {"DELAY "};
  96. static const char ducky_cmd_string[] = {"STRING "};
  97. static const char ducky_cmd_defdelay_1[] = {"DEFAULT_DELAY "};
  98. static const char ducky_cmd_defdelay_2[] = {"DEFAULTDELAY "};
  99. static const char ducky_cmd_repeat[] = {"REPEAT "};
  100. static const char ducky_cmd_altchar[] = {"ALTCHAR "};
  101. static const char ducky_cmd_altstr_1[] = {"ALTSTRING "};
  102. static const char ducky_cmd_altstr_2[] = {"ALTCODE "};
  103. static const uint8_t numpad_keys[10] = {
  104. HID_KEYPAD_0,
  105. HID_KEYPAD_1,
  106. HID_KEYPAD_2,
  107. HID_KEYPAD_3,
  108. HID_KEYPAD_4,
  109. HID_KEYPAD_5,
  110. HID_KEYPAD_6,
  111. HID_KEYPAD_7,
  112. HID_KEYPAD_8,
  113. HID_KEYPAD_9,
  114. };
  115. static bool ducky_get_number(const char* param, uint32_t* val) {
  116. uint32_t value = 0;
  117. if(sscanf(param, "%lu", &value) == 1) {
  118. *val = value;
  119. return true;
  120. }
  121. return false;
  122. }
  123. static uint32_t ducky_get_command_len(const char* line) {
  124. uint32_t len = strlen(line);
  125. for(uint32_t i = 0; i < len; i++) {
  126. if(line[i] == ' ') return i;
  127. }
  128. return 0;
  129. }
  130. static bool ducky_is_line_end(const char chr) {
  131. return ((chr == ' ') || (chr == '\0') || (chr == '\r') || (chr == '\n'));
  132. }
  133. static void ducky_numlock_on() {
  134. if((furi_hal_hid_get_led_state() & HID_KB_LED_NUM) == 0) {
  135. furi_hal_hid_kb_press(HID_KEYBOARD_LOCK_NUM_LOCK);
  136. furi_hal_hid_kb_release(HID_KEYBOARD_LOCK_NUM_LOCK);
  137. }
  138. }
  139. static bool ducky_numpad_press(const char num) {
  140. if((num < '0') || (num > '9')) return false;
  141. uint16_t key = numpad_keys[num - '0'];
  142. furi_hal_hid_kb_press(key);
  143. furi_hal_hid_kb_release(key);
  144. return true;
  145. }
  146. static bool ducky_altchar(const char* charcode) {
  147. uint8_t i = 0;
  148. bool state = false;
  149. FURI_LOG_I(WORKER_TAG, "char %s", charcode);
  150. furi_hal_hid_kb_press(KEY_MOD_LEFT_ALT);
  151. while(!ducky_is_line_end(charcode[i])) {
  152. state = ducky_numpad_press(charcode[i]);
  153. if(state == false) break;
  154. i++;
  155. }
  156. furi_hal_hid_kb_release(KEY_MOD_LEFT_ALT);
  157. return state;
  158. }
  159. static bool ducky_altstring(const char* param) {
  160. uint32_t i = 0;
  161. bool state = false;
  162. while(param[i] != '\0') {
  163. if((param[i] < ' ') || (param[i] > '~')) {
  164. i++;
  165. continue; // Skip non-printable chars
  166. }
  167. char temp_str[4];
  168. snprintf(temp_str, 4, "%u", param[i]);
  169. state = ducky_altchar(temp_str);
  170. if(state == false) break;
  171. i++;
  172. }
  173. return state;
  174. }
  175. static bool ducky_string(const char* param) {
  176. uint32_t i = 0;
  177. while(param[i] != '\0') {
  178. uint16_t keycode = HID_ASCII_TO_KEY(param[i]);
  179. if(keycode != HID_KEYBOARD_NONE) {
  180. furi_hal_hid_kb_press(keycode);
  181. furi_hal_hid_kb_release(keycode);
  182. }
  183. i++;
  184. }
  185. return true;
  186. }
  187. static uint16_t ducky_get_keycode(const char* param, bool accept_chars) {
  188. for(uint8_t i = 0; i < (sizeof(ducky_keys) / sizeof(ducky_keys[0])); i++) {
  189. uint8_t key_cmd_len = strlen(ducky_keys[i].name);
  190. if((strncmp(param, ducky_keys[i].name, key_cmd_len) == 0) &&
  191. (ducky_is_line_end(param[key_cmd_len]))) {
  192. return ducky_keys[i].keycode;
  193. }
  194. }
  195. if((accept_chars) && (strlen(param) > 0)) {
  196. return (HID_ASCII_TO_KEY(param[0]) & 0xFF);
  197. }
  198. return 0;
  199. }
  200. static int32_t ducky_parse_line(BadUsbScript* bad_usb, string_t line) {
  201. uint32_t line_len = string_size(line);
  202. const char* line_tmp = string_get_cstr(line);
  203. bool state = false;
  204. for(uint32_t i = 0; i < line_len; i++) {
  205. if((line_tmp[i] != ' ') && (line_tmp[i] != '\t') && (line_tmp[i] != '\n')) {
  206. line_tmp = &line_tmp[i];
  207. break; // Skip spaces and tabs
  208. }
  209. if(i == line_len - 1) return SCRIPT_STATE_NEXT_LINE; // Skip empty lines
  210. }
  211. FURI_LOG_D(WORKER_TAG, "line:%s", line_tmp);
  212. // General commands
  213. if(strncmp(line_tmp, ducky_cmd_comment, strlen(ducky_cmd_comment)) == 0) {
  214. // REM - comment line
  215. return (0);
  216. } else if(strncmp(line_tmp, ducky_cmd_id, strlen(ducky_cmd_id)) == 0) {
  217. // ID - executed in ducky_script_preload
  218. return (0);
  219. } else if(strncmp(line_tmp, ducky_cmd_delay, strlen(ducky_cmd_delay)) == 0) {
  220. // DELAY
  221. line_tmp = &line_tmp[ducky_get_command_len(line_tmp) + 1];
  222. uint32_t delay_val = 0;
  223. state = ducky_get_number(line_tmp, &delay_val);
  224. if((state) && (delay_val > 0)) {
  225. return (int32_t)delay_val;
  226. }
  227. return SCRIPT_STATE_ERROR;
  228. } else if(
  229. (strncmp(line_tmp, ducky_cmd_defdelay_1, strlen(ducky_cmd_defdelay_1)) == 0) ||
  230. (strncmp(line_tmp, ducky_cmd_defdelay_2, strlen(ducky_cmd_defdelay_2)) == 0)) {
  231. // DEFAULT_DELAY
  232. line_tmp = &line_tmp[ducky_get_command_len(line_tmp) + 1];
  233. state = ducky_get_number(line_tmp, &bad_usb->defdelay);
  234. return (state) ? (0) : SCRIPT_STATE_ERROR;
  235. } else if(strncmp(line_tmp, ducky_cmd_string, strlen(ducky_cmd_string)) == 0) {
  236. // STRING
  237. line_tmp = &line_tmp[ducky_get_command_len(line_tmp) + 1];
  238. state = ducky_string(line_tmp);
  239. return (state) ? (0) : SCRIPT_STATE_ERROR;
  240. } else if(strncmp(line_tmp, ducky_cmd_altchar, strlen(ducky_cmd_altchar)) == 0) {
  241. // ALTCHAR
  242. line_tmp = &line_tmp[ducky_get_command_len(line_tmp) + 1];
  243. ducky_numlock_on();
  244. state = ducky_altchar(line_tmp);
  245. return (state) ? (0) : SCRIPT_STATE_ERROR;
  246. } else if(
  247. (strncmp(line_tmp, ducky_cmd_altstr_1, strlen(ducky_cmd_altstr_1)) == 0) ||
  248. (strncmp(line_tmp, ducky_cmd_altstr_2, strlen(ducky_cmd_altstr_2)) == 0)) {
  249. // ALTSTRING
  250. line_tmp = &line_tmp[ducky_get_command_len(line_tmp) + 1];
  251. ducky_numlock_on();
  252. state = ducky_altstring(line_tmp);
  253. return (state) ? (0) : SCRIPT_STATE_ERROR;
  254. } else if(strncmp(line_tmp, ducky_cmd_repeat, strlen(ducky_cmd_repeat)) == 0) {
  255. // REPEAT
  256. line_tmp = &line_tmp[ducky_get_command_len(line_tmp) + 1];
  257. state = ducky_get_number(line_tmp, &bad_usb->repeat_cnt);
  258. return (state) ? (0) : SCRIPT_STATE_ERROR;
  259. } else {
  260. // Special keys + modifiers
  261. uint16_t key = ducky_get_keycode(line_tmp, false);
  262. if(key == HID_KEYBOARD_NONE) return SCRIPT_STATE_ERROR;
  263. if((key & 0xFF00) != 0) {
  264. // It's a modifier key
  265. line_tmp = &line_tmp[ducky_get_command_len(line_tmp) + 1];
  266. key |= ducky_get_keycode(line_tmp, true);
  267. }
  268. furi_hal_hid_kb_press(key);
  269. furi_hal_hid_kb_release(key);
  270. return (0);
  271. }
  272. return SCRIPT_STATE_ERROR;
  273. }
  274. static bool ducky_set_usb_id(BadUsbScript* bad_usb, const char* line) {
  275. if(sscanf(line, "%lX:%lX", &bad_usb->hid_cfg.vid, &bad_usb->hid_cfg.pid) == 2) {
  276. bad_usb->hid_cfg.manuf[0] = '\0';
  277. bad_usb->hid_cfg.product[0] = '\0';
  278. uint8_t id_len = ducky_get_command_len(line);
  279. if(!ducky_is_line_end(line[id_len + 1])) {
  280. sscanf(
  281. &line[id_len + 1],
  282. "%31[^\r\n:]:%31[^\r\n]",
  283. bad_usb->hid_cfg.manuf,
  284. bad_usb->hid_cfg.product);
  285. }
  286. FURI_LOG_D(
  287. WORKER_TAG,
  288. "set id: %04X:%04X mfr:%s product:%s",
  289. bad_usb->hid_cfg.vid,
  290. bad_usb->hid_cfg.pid,
  291. bad_usb->hid_cfg.manuf,
  292. bad_usb->hid_cfg.product);
  293. return true;
  294. }
  295. return false;
  296. }
  297. static bool ducky_script_preload(BadUsbScript* bad_usb, File* script_file) {
  298. uint8_t ret = 0;
  299. uint32_t line_len = 0;
  300. string_reset(bad_usb->line);
  301. do {
  302. ret = storage_file_read(script_file, bad_usb->file_buf, FILE_BUFFER_LEN);
  303. for(uint16_t i = 0; i < ret; i++) {
  304. if(bad_usb->file_buf[i] == '\n' && line_len > 0) {
  305. bad_usb->st.line_nb++;
  306. line_len = 0;
  307. } else {
  308. if(bad_usb->st.line_nb == 0) { // Save first line
  309. string_push_back(bad_usb->line, bad_usb->file_buf[i]);
  310. }
  311. line_len++;
  312. }
  313. }
  314. if(storage_file_eof(script_file)) {
  315. if(line_len > 0) {
  316. bad_usb->st.line_nb++;
  317. break;
  318. }
  319. }
  320. } while(ret > 0);
  321. const char* line_tmp = string_get_cstr(bad_usb->line);
  322. bool id_set = false; // Looking for ID command at first line
  323. if(strncmp(line_tmp, ducky_cmd_id, strlen(ducky_cmd_id)) == 0) {
  324. id_set = ducky_set_usb_id(bad_usb, &line_tmp[strlen(ducky_cmd_id) + 1]);
  325. }
  326. if(id_set) {
  327. furi_check(furi_hal_usb_set_config(&usb_hid, &bad_usb->hid_cfg));
  328. } else {
  329. furi_check(furi_hal_usb_set_config(&usb_hid, NULL));
  330. }
  331. storage_file_seek(script_file, 0, true);
  332. string_reset(bad_usb->line);
  333. return true;
  334. }
  335. static int32_t ducky_script_execute_next(BadUsbScript* bad_usb, File* script_file) {
  336. int32_t delay_val = 0;
  337. if(bad_usb->repeat_cnt > 0) {
  338. bad_usb->repeat_cnt--;
  339. delay_val = ducky_parse_line(bad_usb, bad_usb->line_prev);
  340. if(delay_val == SCRIPT_STATE_NEXT_LINE) { // Empty line
  341. return 0;
  342. } else if(delay_val < 0) { // Script error
  343. bad_usb->st.error_line = bad_usb->st.line_cur - 1;
  344. FURI_LOG_E(WORKER_TAG, "Unknown command at line %lu", bad_usb->st.line_cur - 1);
  345. return SCRIPT_STATE_ERROR;
  346. } else {
  347. return (delay_val + bad_usb->defdelay);
  348. }
  349. }
  350. string_set(bad_usb->line_prev, bad_usb->line);
  351. string_reset(bad_usb->line);
  352. while(1) {
  353. if(bad_usb->buf_len == 0) {
  354. bad_usb->buf_len = storage_file_read(script_file, bad_usb->file_buf, FILE_BUFFER_LEN);
  355. if(storage_file_eof(script_file)) {
  356. if((bad_usb->buf_len < FILE_BUFFER_LEN) && (bad_usb->file_end == false)) {
  357. bad_usb->file_buf[bad_usb->buf_len] = '\n';
  358. bad_usb->buf_len++;
  359. bad_usb->file_end = true;
  360. }
  361. }
  362. bad_usb->buf_start = 0;
  363. if(bad_usb->buf_len == 0) return SCRIPT_STATE_END;
  364. }
  365. for(uint8_t i = bad_usb->buf_start; i < (bad_usb->buf_start + bad_usb->buf_len); i++) {
  366. if(bad_usb->file_buf[i] == '\n' && string_size(bad_usb->line) > 0) {
  367. bad_usb->st.line_cur++;
  368. bad_usb->buf_len = bad_usb->buf_len + bad_usb->buf_start - (i + 1);
  369. bad_usb->buf_start = i + 1;
  370. delay_val = ducky_parse_line(bad_usb, bad_usb->line);
  371. if(delay_val < 0) {
  372. bad_usb->st.error_line = bad_usb->st.line_cur;
  373. FURI_LOG_E(WORKER_TAG, "Unknown command at line %lu", bad_usb->st.line_cur);
  374. return SCRIPT_STATE_ERROR;
  375. } else {
  376. return (delay_val + bad_usb->defdelay);
  377. }
  378. } else {
  379. string_push_back(bad_usb->line, bad_usb->file_buf[i]);
  380. }
  381. }
  382. bad_usb->buf_len = 0;
  383. if(bad_usb->file_end) return SCRIPT_STATE_END;
  384. }
  385. return 0;
  386. }
  387. static void bad_usb_hid_state_callback(bool state, void* context) {
  388. furi_assert(context);
  389. BadUsbScript* bad_usb = context;
  390. if(state == true)
  391. furi_thread_flags_set(furi_thread_get_id(bad_usb->thread), WorkerEvtConnect);
  392. else
  393. furi_thread_flags_set(furi_thread_get_id(bad_usb->thread), WorkerEvtDisconnect);
  394. }
  395. static int32_t bad_usb_worker(void* context) {
  396. BadUsbScript* bad_usb = context;
  397. BadUsbWorkerState worker_state = BadUsbStateInit;
  398. int32_t delay_val = 0;
  399. FuriHalUsbInterface* usb_mode_prev = furi_hal_usb_get_config();
  400. FURI_LOG_I(WORKER_TAG, "Init");
  401. File* script_file = storage_file_alloc(furi_record_open(RECORD_STORAGE));
  402. string_init(bad_usb->line);
  403. string_init(bad_usb->line_prev);
  404. furi_hal_hid_set_state_callback(bad_usb_hid_state_callback, bad_usb);
  405. while(1) {
  406. if(worker_state == BadUsbStateInit) { // State: initialization
  407. if(storage_file_open(
  408. script_file,
  409. string_get_cstr(bad_usb->file_path),
  410. FSAM_READ,
  411. FSOM_OPEN_EXISTING)) {
  412. if((ducky_script_preload(bad_usb, script_file)) && (bad_usb->st.line_nb > 0)) {
  413. if(furi_hal_hid_is_connected()) {
  414. worker_state = BadUsbStateIdle; // Ready to run
  415. } else {
  416. worker_state = BadUsbStateNotConnected; // USB not connected
  417. }
  418. } else {
  419. worker_state = BadUsbStateScriptError; // Script preload error
  420. }
  421. } else {
  422. FURI_LOG_E(WORKER_TAG, "File open error");
  423. worker_state = BadUsbStateFileError; // File open error
  424. }
  425. bad_usb->st.state = worker_state;
  426. } else if(worker_state == BadUsbStateNotConnected) { // State: USB not connected
  427. uint32_t flags = furi_thread_flags_wait(
  428. WorkerEvtEnd | WorkerEvtConnect, FuriFlagWaitAny, FuriWaitForever);
  429. furi_check((flags & FuriFlagError) == 0);
  430. if(flags & WorkerEvtEnd) {
  431. break;
  432. } else if(flags & WorkerEvtConnect) {
  433. worker_state = BadUsbStateIdle; // Ready to run
  434. }
  435. bad_usb->st.state = worker_state;
  436. } else if(worker_state == BadUsbStateIdle) { // State: ready to start
  437. uint32_t flags = furi_thread_flags_wait(
  438. WorkerEvtEnd | WorkerEvtToggle | WorkerEvtDisconnect,
  439. FuriFlagWaitAny,
  440. FuriWaitForever);
  441. furi_check((flags & FuriFlagError) == 0);
  442. if(flags & WorkerEvtEnd) {
  443. break;
  444. } else if(flags & WorkerEvtToggle) { // Start executing script
  445. DOLPHIN_DEED(DolphinDeedBadUsbPlayScript);
  446. delay_val = 0;
  447. bad_usb->buf_len = 0;
  448. bad_usb->st.line_cur = 0;
  449. bad_usb->defdelay = 0;
  450. bad_usb->repeat_cnt = 0;
  451. bad_usb->file_end = false;
  452. storage_file_seek(script_file, 0, true);
  453. worker_state = BadUsbStateRunning;
  454. } else if(flags & WorkerEvtDisconnect) {
  455. worker_state = BadUsbStateNotConnected; // USB disconnected
  456. }
  457. bad_usb->st.state = worker_state;
  458. } else if(worker_state == BadUsbStateRunning) { // State: running
  459. uint16_t delay_cur = (delay_val > 1000) ? (1000) : (delay_val);
  460. uint32_t flags = furi_thread_flags_wait(
  461. WorkerEvtEnd | WorkerEvtToggle | WorkerEvtDisconnect, FuriFlagWaitAny, delay_cur);
  462. delay_val -= delay_cur;
  463. if(!(flags & FuriFlagError)) {
  464. if(flags & WorkerEvtEnd) {
  465. break;
  466. } else if(flags & WorkerEvtToggle) {
  467. worker_state = BadUsbStateIdle; // Stop executing script
  468. furi_hal_hid_kb_release_all();
  469. } else if(flags & WorkerEvtDisconnect) {
  470. worker_state = BadUsbStateNotConnected; // USB disconnected
  471. furi_hal_hid_kb_release_all();
  472. }
  473. bad_usb->st.state = worker_state;
  474. continue;
  475. } else if((flags == FuriFlagErrorTimeout) || (flags == FuriFlagErrorResource)) {
  476. if(delay_val > 0) {
  477. bad_usb->st.delay_remain--;
  478. continue;
  479. }
  480. bad_usb->st.state = BadUsbStateRunning;
  481. delay_val = ducky_script_execute_next(bad_usb, script_file);
  482. if(delay_val == SCRIPT_STATE_ERROR) { // Script error
  483. delay_val = 0;
  484. worker_state = BadUsbStateScriptError;
  485. bad_usb->st.state = worker_state;
  486. } else if(delay_val == SCRIPT_STATE_END) { // End of script
  487. delay_val = 0;
  488. worker_state = BadUsbStateIdle;
  489. bad_usb->st.state = BadUsbStateDone;
  490. furi_hal_hid_kb_release_all();
  491. continue;
  492. } else if(delay_val > 1000) {
  493. bad_usb->st.state = BadUsbStateDelay; // Show long delays
  494. bad_usb->st.delay_remain = delay_val / 1000;
  495. }
  496. } else {
  497. furi_check((flags & FuriFlagError) == 0);
  498. }
  499. } else if(
  500. (worker_state == BadUsbStateFileError) ||
  501. (worker_state == BadUsbStateScriptError)) { // State: error
  502. uint32_t flags = furi_thread_flags_wait(
  503. WorkerEvtEnd, FuriFlagWaitAny, FuriWaitForever); // Waiting for exit command
  504. furi_check((flags & FuriFlagError) == 0);
  505. if(flags & WorkerEvtEnd) {
  506. break;
  507. }
  508. }
  509. }
  510. furi_hal_hid_set_state_callback(NULL, NULL);
  511. furi_hal_usb_set_config(usb_mode_prev, NULL);
  512. storage_file_close(script_file);
  513. storage_file_free(script_file);
  514. string_clear(bad_usb->line);
  515. string_clear(bad_usb->line_prev);
  516. FURI_LOG_I(WORKER_TAG, "End");
  517. return 0;
  518. }
  519. BadUsbScript* bad_usb_script_open(string_t file_path) {
  520. furi_assert(file_path);
  521. BadUsbScript* bad_usb = malloc(sizeof(BadUsbScript));
  522. string_init(bad_usb->file_path);
  523. string_set(bad_usb->file_path, file_path);
  524. bad_usb->st.state = BadUsbStateInit;
  525. bad_usb->thread = furi_thread_alloc();
  526. furi_thread_set_name(bad_usb->thread, "BadUsbWorker");
  527. furi_thread_set_stack_size(bad_usb->thread, 2048);
  528. furi_thread_set_context(bad_usb->thread, bad_usb);
  529. furi_thread_set_callback(bad_usb->thread, bad_usb_worker);
  530. furi_thread_start(bad_usb->thread);
  531. return bad_usb;
  532. }
  533. void bad_usb_script_close(BadUsbScript* bad_usb) {
  534. furi_assert(bad_usb);
  535. furi_thread_flags_set(furi_thread_get_id(bad_usb->thread), WorkerEvtEnd);
  536. furi_thread_join(bad_usb->thread);
  537. furi_thread_free(bad_usb->thread);
  538. string_clear(bad_usb->file_path);
  539. free(bad_usb);
  540. }
  541. void bad_usb_script_toggle(BadUsbScript* bad_usb) {
  542. furi_assert(bad_usb);
  543. furi_thread_flags_set(furi_thread_get_id(bad_usb->thread), WorkerEvtToggle);
  544. }
  545. BadUsbState* bad_usb_script_get_state(BadUsbScript* bad_usb) {
  546. furi_assert(bad_usb);
  547. return &(bad_usb->st);
  548. }