ducky_script.c 34 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935
  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. if(app->has_usb_id) {
  331. //app->is_bt = false;
  332. app->set_usb_id = ducky_set_usb_id(bad_kb, &line_tmp[strlen(ducky_cmd_id) + 1]);
  333. } else if(app->has_bt_id) {
  334. //app->is_bt = true;
  335. app->set_bt_id = ducky_set_bt_id(bad_kb, &line_tmp[strlen(ducky_cmd_bt_id) + 1]);
  336. }
  337. storage_file_seek(script_file, 0, true);
  338. furi_string_reset(bad_kb->line);
  339. }
  340. static int32_t ducky_script_execute_next(BadKbScript* bad_kb, File* script_file) {
  341. int32_t delay_val = 0;
  342. if(bad_kb->repeat_cnt > 0) {
  343. bad_kb->repeat_cnt--;
  344. delay_val = ducky_parse_line(bad_kb, bad_kb->line_prev);
  345. if(delay_val == SCRIPT_STATE_NEXT_LINE) { // Empty line
  346. return 0;
  347. } else if(delay_val == SCRIPT_STATE_STRING_START) { // Print string with delays
  348. return delay_val;
  349. } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // wait for button
  350. return delay_val;
  351. } else if(delay_val < 0) { // Script error
  352. bad_kb->st.error_line = bad_kb->st.line_cur - 1;
  353. FURI_LOG_E(WORKER_TAG, "Unknown command at line %zu", bad_kb->st.line_cur - 1U);
  354. return SCRIPT_STATE_ERROR;
  355. } else {
  356. return (delay_val + bad_kb->defdelay);
  357. }
  358. }
  359. furi_string_set(bad_kb->line_prev, bad_kb->line);
  360. furi_string_reset(bad_kb->line);
  361. while(1) {
  362. if(bad_kb->buf_len == 0) {
  363. bad_kb->buf_len = storage_file_read(script_file, bad_kb->file_buf, FILE_BUFFER_LEN);
  364. if(storage_file_eof(script_file)) {
  365. if((bad_kb->buf_len < FILE_BUFFER_LEN) && (bad_kb->file_end == false)) {
  366. bad_kb->file_buf[bad_kb->buf_len] = '\n';
  367. bad_kb->buf_len++;
  368. bad_kb->file_end = true;
  369. }
  370. }
  371. bad_kb->buf_start = 0;
  372. if(bad_kb->buf_len == 0) return SCRIPT_STATE_END;
  373. }
  374. for(uint8_t i = bad_kb->buf_start; i < (bad_kb->buf_start + bad_kb->buf_len); i++) {
  375. if(bad_kb->file_buf[i] == '\n' && furi_string_size(bad_kb->line) > 0) {
  376. bad_kb->st.line_cur++;
  377. bad_kb->buf_len = bad_kb->buf_len + bad_kb->buf_start - (i + 1);
  378. bad_kb->buf_start = i + 1;
  379. furi_string_trim(bad_kb->line);
  380. delay_val = ducky_parse_line(bad_kb, bad_kb->line);
  381. if(delay_val == SCRIPT_STATE_NEXT_LINE) { // Empty line
  382. return 0;
  383. } else if(delay_val == SCRIPT_STATE_STRING_START) { // Print string with delays
  384. return delay_val;
  385. } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // wait for button
  386. return delay_val;
  387. } else if(delay_val < 0) {
  388. bad_kb->st.error_line = bad_kb->st.line_cur;
  389. FURI_LOG_E(WORKER_TAG, "Unknown command at line %zu", bad_kb->st.line_cur);
  390. return SCRIPT_STATE_ERROR;
  391. } else {
  392. return (delay_val + bad_kb->defdelay);
  393. }
  394. } else {
  395. furi_string_push_back(bad_kb->line, bad_kb->file_buf[i]);
  396. }
  397. }
  398. bad_kb->buf_len = 0;
  399. if(bad_kb->file_end) return SCRIPT_STATE_END;
  400. }
  401. return 0;
  402. }
  403. void bad_kb_bt_hid_state_callback(BtStatus status, void* context) {
  404. furi_assert(context);
  405. BadKbScript* bad_kb = context;
  406. bool state = (status == BtStatusConnected);
  407. if(state == true) {
  408. LevelRssiRange r = bt_remote_rssi_range(bad_kb->bt);
  409. if(r != LevelRssiError) {
  410. bt_timeout = bt_hid_delays[r];
  411. }
  412. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtConnect);
  413. } else {
  414. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtDisconnect);
  415. }
  416. }
  417. void bad_kb_usb_hid_state_callback(bool state, void* context) {
  418. furi_assert(context);
  419. BadKbScript* bad_kb = context;
  420. if(state == true) {
  421. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtConnect);
  422. } else {
  423. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtDisconnect);
  424. }
  425. }
  426. static uint32_t bad_kb_flags_get(uint32_t flags_mask, uint32_t timeout) {
  427. uint32_t flags = furi_thread_flags_get();
  428. furi_check((flags & FuriFlagError) == 0);
  429. if(flags == 0) {
  430. flags = furi_thread_flags_wait(flags_mask, FuriFlagWaitAny, timeout);
  431. furi_check(((flags & FuriFlagError) == 0) || (flags == (unsigned)FuriFlagErrorTimeout));
  432. } else {
  433. uint32_t state = furi_thread_flags_clear(flags);
  434. furi_check((state & FuriFlagError) == 0);
  435. }
  436. return flags;
  437. }
  438. static int32_t bad_kb_worker(void* context) {
  439. BadKbScript* bad_kb = context;
  440. BadKbWorkerState worker_state = BadKbStateInit;
  441. BadKbWorkerState pause_state = BadKbStateRunning;
  442. int32_t delay_val = 0;
  443. FURI_LOG_I(WORKER_TAG, "Init");
  444. File* script_file = storage_file_alloc(furi_record_open(RECORD_STORAGE));
  445. bad_kb->line = furi_string_alloc();
  446. bad_kb->line_prev = furi_string_alloc();
  447. bad_kb->string_print = furi_string_alloc();
  448. bad_kb->st.elapsed = 0;
  449. while(1) {
  450. uint32_t start = furi_get_tick();
  451. if(worker_state == BadKbStateInit) { // State: initialization
  452. start = 0;
  453. FURI_LOG_D(WORKER_TAG, "init start");
  454. if(storage_file_open(
  455. script_file,
  456. furi_string_get_cstr(bad_kb->file_path),
  457. FSAM_READ,
  458. FSOM_OPEN_EXISTING)) {
  459. ducky_script_preload(bad_kb, script_file);
  460. if(bad_kb->st.line_nb > 0) {
  461. bad_kb_config_refresh(bad_kb->app);
  462. worker_state = BadKbStateNotConnected; // Refresh will set connected flag
  463. } else {
  464. worker_state = BadKbStateScriptError; // Script preload error
  465. }
  466. } else {
  467. FURI_LOG_E(WORKER_TAG, "File open error");
  468. worker_state = BadKbStateFileError; // File open error
  469. }
  470. bad_kb->st.state = worker_state;
  471. FURI_LOG_D(WORKER_TAG, "init done");
  472. } else if(worker_state == BadKbStateNotConnected) { // State: Not connected
  473. start = 0;
  474. FURI_LOG_D(WORKER_TAG, "not connected wait");
  475. uint32_t flags = bad_kb_flags_get(
  476. WorkerEvtEnd | WorkerEvtConnect | WorkerEvtDisconnect | WorkerEvtStartStop,
  477. FuriWaitForever);
  478. FURI_LOG_D(WORKER_TAG, "not connected flags: %lu", flags);
  479. if(flags & WorkerEvtEnd) {
  480. break;
  481. } else if(flags & WorkerEvtConnect) {
  482. worker_state = BadKbStateIdle; // Ready to run
  483. } else if(flags & WorkerEvtStartStop) {
  484. worker_state = BadKbStateWillRun; // Will run when connected
  485. }
  486. bad_kb->st.state = worker_state;
  487. } else if(worker_state == BadKbStateIdle) { // State: ready to start
  488. start = 0;
  489. FURI_LOG_D(WORKER_TAG, "idle wait");
  490. uint32_t flags = bad_kb_flags_get(
  491. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtConnect | WorkerEvtDisconnect,
  492. FuriWaitForever);
  493. FURI_LOG_D(WORKER_TAG, "idle flags: %lu", flags);
  494. if(flags & WorkerEvtEnd) {
  495. break;
  496. } else if(flags & WorkerEvtStartStop) { // Start executing script
  497. //dolphin_deed(DolphinDeedBadKbPlayScript);
  498. delay_val = 0;
  499. bad_kb->buf_len = 0;
  500. bad_kb->st.line_cur = 0;
  501. bad_kb->defdelay = 0;
  502. bad_kb->stringdelay = 0;
  503. bad_kb->repeat_cnt = 0;
  504. bad_kb->key_hold_nb = 0;
  505. bad_kb->file_end = false;
  506. storage_file_seek(script_file, 0, true);
  507. bad_kb_script_set_keyboard_layout(bad_kb, bad_kb->keyboard_layout);
  508. worker_state = BadKbStateRunning;
  509. bad_kb->st.elapsed = 0;
  510. } else if(flags & WorkerEvtDisconnect) {
  511. worker_state = BadKbStateNotConnected; // Disconnected
  512. }
  513. bad_kb->st.state = worker_state;
  514. } else if(worker_state == BadKbStateWillRun) { // State: start on connection
  515. start = 0;
  516. FURI_LOG_D(WORKER_TAG, "will run wait");
  517. uint32_t flags = bad_kb_flags_get(
  518. WorkerEvtEnd | WorkerEvtConnect | WorkerEvtDisconnect | WorkerEvtStartStop,
  519. FuriWaitForever);
  520. FURI_LOG_D(WORKER_TAG, "will run flags: %lu", flags);
  521. if(flags & WorkerEvtEnd) {
  522. break;
  523. } else if(flags & WorkerEvtConnect) { // Start executing script
  524. //dolphin_deed(DolphinDeedBadKbPlayScript);
  525. delay_val = 0;
  526. bad_kb->buf_len = 0;
  527. bad_kb->st.line_cur = 0;
  528. bad_kb->defdelay = 0;
  529. bad_kb->stringdelay = 0;
  530. bad_kb->repeat_cnt = 0;
  531. bad_kb->file_end = false;
  532. storage_file_seek(script_file, 0, true);
  533. // extra time for PC to recognize Flipper as keyboard
  534. flags = furi_thread_flags_wait(
  535. WorkerEvtEnd | WorkerEvtDisconnect | WorkerEvtStartStop,
  536. FuriFlagWaitAny | FuriFlagNoClear,
  537. bad_kb->bt ? 3000 : 1500);
  538. if(flags == (unsigned)FuriFlagErrorTimeout) {
  539. // If nothing happened - start script execution
  540. worker_state = BadKbStateRunning;
  541. bad_kb->st.elapsed = 0;
  542. } else if(flags & WorkerEvtStartStop) {
  543. worker_state = BadKbStateIdle;
  544. furi_thread_flags_clear(WorkerEvtStartStop);
  545. }
  546. if(bad_kb->bt) {
  547. update_bt_timeout(bad_kb->bt);
  548. }
  549. bad_kb_script_set_keyboard_layout(bad_kb, bad_kb->keyboard_layout);
  550. } else if(flags & WorkerEvtStartStop) { // Cancel scheduled execution
  551. worker_state = BadKbStateNotConnected;
  552. }
  553. bad_kb->st.state = worker_state;
  554. } else if(worker_state == BadKbStateRunning) { // State: running
  555. FURI_LOG_D(WORKER_TAG, "running");
  556. uint16_t delay_cur = (delay_val > 100) ? (100) : (delay_val);
  557. uint32_t flags = furi_thread_flags_wait(
  558. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  559. WorkerEvtDisconnect,
  560. FuriFlagWaitAny,
  561. delay_cur);
  562. FURI_LOG_D(WORKER_TAG, "running flags: %lu", flags);
  563. delay_val -= delay_cur;
  564. if(!(flags & FuriFlagError)) {
  565. if(flags & WorkerEvtEnd) {
  566. break;
  567. } else if(flags & WorkerEvtStartStop) {
  568. worker_state = BadKbStateIdle; // Stop executing script
  569. if(bad_kb->bt) {
  570. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  571. } else {
  572. furi_hal_hid_kb_release_all();
  573. }
  574. } else if(flags & WorkerEvtDisconnect) {
  575. worker_state = BadKbStateNotConnected; // Disconnected
  576. if(bad_kb->bt) {
  577. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  578. } else {
  579. furi_hal_hid_kb_release_all();
  580. }
  581. } else if(flags & WorkerEvtPauseResume) {
  582. pause_state = BadKbStateRunning;
  583. worker_state = BadKbStatePaused; // Pause
  584. }
  585. bad_kb->st.state = worker_state;
  586. bad_kb->st.elapsed += (furi_get_tick() - start);
  587. continue;
  588. } else if(
  589. (flags == (unsigned)FuriFlagErrorTimeout) ||
  590. (flags == (unsigned)FuriFlagErrorResource)) {
  591. if(delay_val > 0) {
  592. bad_kb->st.delay_remain--;
  593. bad_kb->st.elapsed += (furi_get_tick() - start);
  594. continue;
  595. }
  596. bad_kb->st.state = BadKbStateRunning;
  597. delay_val = ducky_script_execute_next(bad_kb, script_file);
  598. if(delay_val == SCRIPT_STATE_ERROR) { // Script error
  599. delay_val = 0;
  600. worker_state = BadKbStateScriptError;
  601. bad_kb->st.state = worker_state;
  602. if(bad_kb->bt) {
  603. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  604. } else {
  605. furi_hal_hid_kb_release_all();
  606. }
  607. } else if(delay_val == SCRIPT_STATE_END) { // End of script
  608. delay_val = 0;
  609. worker_state = BadKbStateIdle;
  610. bad_kb->st.state = BadKbStateDone;
  611. if(bad_kb->bt) {
  612. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  613. } else {
  614. furi_hal_hid_kb_release_all();
  615. }
  616. bad_kb->st.elapsed += (furi_get_tick() - start);
  617. continue;
  618. } else if(delay_val == SCRIPT_STATE_STRING_START) { // Start printing string with delays
  619. delay_val = bad_kb->defdelay;
  620. bad_kb->string_print_pos = 0;
  621. worker_state = BadKbStateStringDelay;
  622. } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // set state to wait for user input
  623. worker_state = BadKbStateWaitForBtn;
  624. bad_kb->st.state = BadKbStateWaitForBtn; // Show long delays
  625. } else if(delay_val > 100) {
  626. bad_kb->st.state = BadKbStateDelay; // Show long delays
  627. bad_kb->st.delay_remain = delay_val / 100;
  628. }
  629. } else {
  630. furi_check((flags & FuriFlagError) == 0);
  631. }
  632. } else if(worker_state == BadKbStateWaitForBtn) { // State: Wait for button Press
  633. start = 0;
  634. FURI_LOG_D(WORKER_TAG, "button wait");
  635. uint32_t flags = bad_kb_flags_get(
  636. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  637. WorkerEvtDisconnect,
  638. FuriWaitForever);
  639. FURI_LOG_D(WORKER_TAG, "button flags: %lu", flags);
  640. if(!(flags & FuriFlagError)) {
  641. if(flags & WorkerEvtEnd) {
  642. break;
  643. } else if(flags & WorkerEvtStartStop) {
  644. delay_val = 0;
  645. worker_state = BadKbStateRunning;
  646. } else if(flags & WorkerEvtDisconnect) {
  647. worker_state = BadKbStateNotConnected; // Disconnected
  648. if(bad_kb->bt) {
  649. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  650. } else {
  651. furi_hal_hid_kb_release_all();
  652. }
  653. }
  654. bad_kb->st.state = worker_state;
  655. continue;
  656. }
  657. } else if(worker_state == BadKbStatePaused) { // State: Paused
  658. start = 0;
  659. FURI_LOG_D(WORKER_TAG, "paused wait");
  660. uint32_t flags = bad_kb_flags_get(
  661. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  662. WorkerEvtDisconnect,
  663. FuriWaitForever);
  664. FURI_LOG_D(WORKER_TAG, "paused flags: %lu", flags);
  665. if(!(flags & FuriFlagError)) {
  666. if(flags & WorkerEvtEnd) {
  667. break;
  668. } else if(flags & WorkerEvtStartStop) {
  669. worker_state = BadKbStateIdle; // Stop executing script
  670. bad_kb->st.state = worker_state;
  671. if(bad_kb->bt) {
  672. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  673. } else {
  674. furi_hal_hid_kb_release_all();
  675. }
  676. } else if(flags & WorkerEvtDisconnect) {
  677. worker_state = BadKbStateNotConnected; // Disconnected
  678. bad_kb->st.state = worker_state;
  679. if(bad_kb->bt) {
  680. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  681. } else {
  682. furi_hal_hid_kb_release_all();
  683. }
  684. } else if(flags & WorkerEvtPauseResume) {
  685. if(pause_state == BadKbStateRunning) {
  686. if(delay_val > 0) {
  687. bad_kb->st.state = BadKbStateDelay;
  688. bad_kb->st.delay_remain = delay_val / 100;
  689. } else {
  690. bad_kb->st.state = BadKbStateRunning;
  691. delay_val = 0;
  692. }
  693. worker_state = BadKbStateRunning; // Resume
  694. } else if(pause_state == BadKbStateStringDelay) {
  695. bad_kb->st.state = BadKbStateRunning;
  696. worker_state = BadKbStateStringDelay; // Resume
  697. }
  698. }
  699. continue;
  700. }
  701. } else if(worker_state == BadKbStateStringDelay) { // State: print string with delays
  702. FURI_LOG_D(WORKER_TAG, "delay wait");
  703. uint32_t flags = bad_kb_flags_get(
  704. WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
  705. WorkerEvtDisconnect,
  706. bad_kb->stringdelay);
  707. FURI_LOG_D(WORKER_TAG, "delay flags: %lu", flags);
  708. if(!(flags & FuriFlagError)) {
  709. if(flags & WorkerEvtEnd) {
  710. break;
  711. } else if(flags & WorkerEvtStartStop) {
  712. worker_state = BadKbStateIdle; // Stop executing script
  713. if(bad_kb->bt) {
  714. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  715. } else {
  716. furi_hal_hid_kb_release_all();
  717. }
  718. } else if(flags & WorkerEvtDisconnect) {
  719. worker_state = BadKbStateNotConnected; // Disconnected
  720. if(bad_kb->bt) {
  721. ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
  722. } else {
  723. furi_hal_hid_kb_release_all();
  724. }
  725. } else if(flags & WorkerEvtPauseResume) {
  726. pause_state = BadKbStateStringDelay;
  727. worker_state = BadKbStatePaused; // Pause
  728. }
  729. bad_kb->st.state = worker_state;
  730. bad_kb->st.elapsed += (furi_get_tick() - start);
  731. continue;
  732. } else if(
  733. (flags == (unsigned)FuriFlagErrorTimeout) ||
  734. (flags == (unsigned)FuriFlagErrorResource)) {
  735. bool string_end = ducky_string_next(bad_kb);
  736. if(string_end) {
  737. bad_kb->stringdelay = 0;
  738. worker_state = BadKbStateRunning;
  739. }
  740. } else {
  741. furi_check((flags & FuriFlagError) == 0);
  742. }
  743. } else if(
  744. (worker_state == BadKbStateFileError) ||
  745. (worker_state == BadKbStateScriptError)) { // State: error
  746. start = 0;
  747. FURI_LOG_D(WORKER_TAG, "error wait");
  748. uint32_t flags =
  749. bad_kb_flags_get(WorkerEvtEnd, FuriWaitForever); // Waiting for exit command
  750. FURI_LOG_D(WORKER_TAG, "error flags: %lu", flags);
  751. if(flags & WorkerEvtEnd) {
  752. break;
  753. }
  754. }
  755. if(bad_kb->bt) {
  756. update_bt_timeout(bad_kb->bt);
  757. }
  758. if(start) {
  759. bad_kb->st.elapsed += (furi_get_tick() - start);
  760. }
  761. }
  762. bt_set_status_changed_callback(bad_kb->app->bt, NULL, NULL);
  763. furi_hal_hid_set_state_callback(NULL, NULL);
  764. storage_file_close(script_file);
  765. storage_file_free(script_file);
  766. furi_string_free(bad_kb->line);
  767. furi_string_free(bad_kb->line_prev);
  768. furi_string_free(bad_kb->string_print);
  769. FURI_LOG_I(WORKER_TAG, "End");
  770. return 0;
  771. }
  772. static void bad_kb_script_set_default_keyboard_layout(BadKbScript* bad_kb) {
  773. furi_assert(bad_kb);
  774. furi_string_set_str(bad_kb->keyboard_layout, "");
  775. memset(bad_kb->layout, HID_KEYBOARD_NONE, sizeof(bad_kb->layout));
  776. memcpy(bad_kb->layout, hid_asciimap, MIN(sizeof(hid_asciimap), sizeof(bad_kb->layout)));
  777. }
  778. BadKbScript* bad_kb_script_open(FuriString* file_path, Bt* bt, BadKbApp* app) {
  779. furi_assert(file_path);
  780. BadKbScript* bad_kb = malloc(sizeof(BadKbScript));
  781. bad_kb->app = app;
  782. bad_kb->file_path = furi_string_alloc();
  783. furi_string_set(bad_kb->file_path, file_path);
  784. bad_kb->keyboard_layout = furi_string_alloc();
  785. bad_kb_script_set_default_keyboard_layout(bad_kb);
  786. bad_kb->st.state = BadKbStateInit;
  787. bad_kb->st.error[0] = '\0';
  788. bad_kb->st.is_bt = !!bt;
  789. bad_kb->bt = bt;
  790. bad_kb->thread = furi_thread_alloc_ex("BadKbWorker", 2048, bad_kb_worker, bad_kb);
  791. furi_thread_start(bad_kb->thread);
  792. return bad_kb;
  793. } //-V773
  794. void bad_kb_script_close(BadKbScript* bad_kb) {
  795. furi_assert(bad_kb);
  796. furi_record_close(RECORD_STORAGE);
  797. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtEnd);
  798. furi_thread_join(bad_kb->thread);
  799. furi_thread_free(bad_kb->thread);
  800. furi_string_free(bad_kb->file_path);
  801. furi_string_free(bad_kb->keyboard_layout);
  802. free(bad_kb);
  803. }
  804. void bad_kb_script_set_keyboard_layout(BadKbScript* bad_kb, FuriString* layout_path) {
  805. furi_assert(bad_kb);
  806. if((bad_kb->st.state == BadKbStateRunning) || (bad_kb->st.state == BadKbStateDelay)) {
  807. // do not update keyboard layout while a script is running
  808. return;
  809. }
  810. File* layout_file = storage_file_alloc(furi_record_open(RECORD_STORAGE));
  811. if(!furi_string_empty(layout_path)) { //-V1051
  812. furi_string_set(bad_kb->keyboard_layout, layout_path);
  813. if(storage_file_open(
  814. layout_file, furi_string_get_cstr(layout_path), FSAM_READ, FSOM_OPEN_EXISTING)) {
  815. uint16_t layout[128];
  816. if(storage_file_read(layout_file, layout, sizeof(layout)) == sizeof(layout)) {
  817. memcpy(bad_kb->layout, layout, sizeof(layout));
  818. }
  819. }
  820. storage_file_close(layout_file);
  821. } else {
  822. bad_kb_script_set_default_keyboard_layout(bad_kb);
  823. }
  824. storage_file_free(layout_file);
  825. }
  826. void bad_kb_script_start_stop(BadKbScript* bad_kb) {
  827. furi_assert(bad_kb);
  828. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtStartStop);
  829. }
  830. void bad_kb_script_pause_resume(BadKbScript* bad_kb) {
  831. furi_assert(bad_kb);
  832. furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtPauseResume);
  833. }
  834. BadKbState* bad_kb_script_get_state(BadKbScript* bad_kb) {
  835. furi_assert(bad_kb);
  836. return &(bad_kb->st);
  837. }