| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935 |
- #include "../bad_kb_app_i.h"
- #include <furi.h>
- #include <furi_hal.h>
- #include <gui/gui.h>
- #include <input/input.h>
- #include <lib/toolbox/args.h>
- #include <furi_hal_usb_hid.h>
- #include "ble_hid.h"
- #include <storage/storage.h>
- #include "ducky_script.h"
- #include "ducky_script_i.h"
- #include <dolphin/dolphin.h>
- #include <toolbox/hex.h>
- #define TAG "BadKb"
- #define WORKER_TAG TAG "Worker"
- #define BADKB_ASCII_TO_KEY(script, x) \
- (((uint8_t)x < 128) ? (script->layout[(uint8_t)x]) : HID_KEYBOARD_NONE)
- // Delays for waiting between HID key press and key release
- const uint8_t bt_hid_delays[LevelRssiNum] = {
- 60, // LevelRssi122_100
- 55, // LevelRssi99_80
- 50, // LevelRssi79_60
- 47, // LevelRssi59_40
- 34, // LevelRssi39_0
- };
- uint8_t bt_timeout = 0;
- static LevelRssiRange bt_remote_rssi_range(Bt* bt) {
- uint8_t rssi;
- if(!bt_remote_rssi(bt, &rssi)) return LevelRssiError;
- if(rssi <= 39)
- return LevelRssi39_0;
- else if(rssi <= 59)
- return LevelRssi59_40;
- else if(rssi <= 79)
- return LevelRssi79_60;
- else if(rssi <= 99)
- return LevelRssi99_80;
- else if(rssi <= 122)
- return LevelRssi122_100;
- return LevelRssiError;
- }
- static inline void update_bt_timeout(Bt* bt) {
- LevelRssiRange r = bt_remote_rssi_range(bt);
- if(r < LevelRssiNum) {
- bt_timeout = bt_hid_delays[r];
- FURI_LOG_D(WORKER_TAG, "BLE Key timeout : %u", bt_timeout);
- }
- }
- static const char ducky_cmd_id[] = {"ID"};
- static const char ducky_cmd_bt_id[] = {"BT_ID"};
- static const uint8_t numpad_keys[10] = {
- HID_KEYPAD_0,
- HID_KEYPAD_1,
- HID_KEYPAD_2,
- HID_KEYPAD_3,
- HID_KEYPAD_4,
- HID_KEYPAD_5,
- HID_KEYPAD_6,
- HID_KEYPAD_7,
- HID_KEYPAD_8,
- HID_KEYPAD_9,
- };
- uint32_t ducky_get_command_len(const char* line) {
- uint32_t len = strlen(line);
- for(uint32_t i = 0; i < len; i++) {
- if(line[i] == ' ') return i;
- }
- return 0;
- }
- bool ducky_is_line_end(const char chr) {
- return ((chr == ' ') || (chr == '\0') || (chr == '\r') || (chr == '\n'));
- }
- uint16_t ducky_get_keycode(BadKbScript* bad_kb, const char* param, bool accept_chars) {
- uint16_t keycode = ducky_get_keycode_by_name(param);
- if(keycode != HID_KEYBOARD_NONE) {
- return keycode;
- }
- if((accept_chars) && (strlen(param) > 0)) {
- return (BADKB_ASCII_TO_KEY(bad_kb, param[0]) & 0xFF);
- }
- return 0;
- }
- bool ducky_get_number(const char* param, uint32_t* val) {
- uint32_t value = 0;
- if(sscanf(param, "%lu", &value) == 1) {
- *val = value;
- return true;
- }
- return false;
- }
- uint8_t furi_hal_bt_hid_get_led_state() {
- // FIXME
- return 0;
- }
- void ducky_numlock_on(BadKbScript* bad_kb) {
- if(bad_kb->bt) {
- if((furi_hal_bt_hid_get_led_state() & HID_KB_LED_NUM) == 0) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, HID_KEYBOARD_LOCK_NUM_LOCK);
- furi_delay_ms(bt_timeout);
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, HID_KEYBOARD_LOCK_NUM_LOCK);
- }
- } else {
- if((furi_hal_hid_get_led_state() & HID_KB_LED_NUM) == 0) {
- furi_hal_hid_kb_press(HID_KEYBOARD_LOCK_NUM_LOCK);
- furi_hal_hid_kb_release(HID_KEYBOARD_LOCK_NUM_LOCK);
- }
- }
- }
- bool ducky_numpad_press(BadKbScript* bad_kb, const char num) {
- if((num < '0') || (num > '9')) return false;
- uint16_t key = numpad_keys[num - '0'];
- if(bad_kb->bt) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, key);
- furi_delay_ms(bt_timeout);
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, key);
- } else {
- furi_hal_hid_kb_press(key);
- furi_hal_hid_kb_release(key);
- }
- return true;
- }
- bool ducky_altchar(BadKbScript* bad_kb, const char* charcode) {
- uint8_t i = 0;
- bool state = false;
- if(bad_kb->bt) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, KEY_MOD_LEFT_ALT);
- } else {
- furi_hal_hid_kb_press(KEY_MOD_LEFT_ALT);
- }
- while(!ducky_is_line_end(charcode[i])) {
- state = ducky_numpad_press(bad_kb, charcode[i]);
- if(state == false) break;
- i++;
- }
- if(bad_kb->bt) {
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, KEY_MOD_LEFT_ALT);
- } else {
- furi_hal_hid_kb_release(KEY_MOD_LEFT_ALT);
- }
- return state;
- }
- bool ducky_altstring(BadKbScript* bad_kb, const char* param) {
- uint32_t i = 0;
- bool state = false;
- while(param[i] != '\0') {
- if((param[i] < ' ') || (param[i] > '~')) {
- i++;
- continue; // Skip non-printable chars
- }
- char temp_str[4];
- snprintf(temp_str, 4, "%u", param[i]);
- state = ducky_altchar(bad_kb, temp_str);
- if(state == false) break;
- i++;
- }
- return state;
- }
- int32_t ducky_error(BadKbScript* bad_kb, const char* text, ...) {
- va_list args;
- va_start(args, text);
- vsnprintf(bad_kb->st.error, sizeof(bad_kb->st.error), text, args);
- va_end(args);
- return SCRIPT_STATE_ERROR;
- }
- bool ducky_string(BadKbScript* bad_kb, const char* param) {
- uint32_t i = 0;
- while(param[i] != '\0') {
- if(param[i] != '\n') {
- uint16_t keycode = BADKB_ASCII_TO_KEY(bad_kb, param[i]);
- if(keycode != HID_KEYBOARD_NONE) {
- if(bad_kb->bt) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, keycode);
- furi_delay_ms(bt_timeout);
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, keycode);
- } else {
- furi_hal_hid_kb_press(keycode);
- furi_hal_hid_kb_release(keycode);
- }
- }
- } else {
- if(bad_kb->bt) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
- furi_delay_ms(bt_timeout);
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
- } else {
- furi_hal_hid_kb_press(HID_KEYBOARD_RETURN);
- furi_hal_hid_kb_release(HID_KEYBOARD_RETURN);
- }
- }
- i++;
- }
- bad_kb->stringdelay = 0;
- return true;
- }
- static bool ducky_string_next(BadKbScript* bad_kb) {
- if(bad_kb->string_print_pos >= furi_string_size(bad_kb->string_print)) {
- return true;
- }
- char print_char = furi_string_get_char(bad_kb->string_print, bad_kb->string_print_pos);
- if(print_char != '\n') {
- uint16_t keycode = BADKB_ASCII_TO_KEY(bad_kb, print_char);
- if(keycode != HID_KEYBOARD_NONE) {
- if(bad_kb->bt) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, keycode);
- furi_delay_ms(bt_timeout);
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, keycode);
- } else {
- furi_hal_hid_kb_press(keycode);
- furi_hal_hid_kb_release(keycode);
- }
- }
- } else {
- if(bad_kb->bt) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
- furi_delay_ms(bt_timeout);
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, HID_KEYBOARD_RETURN);
- } else {
- furi_hal_hid_kb_press(HID_KEYBOARD_RETURN);
- furi_hal_hid_kb_release(HID_KEYBOARD_RETURN);
- }
- }
- bad_kb->string_print_pos++;
- return false;
- }
- static int32_t ducky_parse_line(BadKbScript* bad_kb, FuriString* line) {
- uint32_t line_len = furi_string_size(line);
- const char* line_tmp = furi_string_get_cstr(line);
- if(line_len == 0) {
- return SCRIPT_STATE_NEXT_LINE; // Skip empty lines
- }
- FURI_LOG_D(WORKER_TAG, "line:%s", line_tmp);
- // Ducky Lang Functions
- int32_t cmd_result = ducky_execute_cmd(bad_kb, line_tmp);
- if(cmd_result != SCRIPT_STATE_CMD_UNKNOWN) {
- return cmd_result;
- }
- // Special keys + modifiers
- uint16_t key = ducky_get_keycode(bad_kb, line_tmp, false);
- if(key == HID_KEYBOARD_NONE) {
- return ducky_error(bad_kb, "No keycode defined for %s", line_tmp);
- }
- if((key & 0xFF00) != 0) {
- // It's a modifier key
- uint32_t offset = ducky_get_command_len(line_tmp) + 1;
- // ducky_get_command_len() returns 0 without space, so check for != 1
- if(offset != 1 && line_len > offset) {
- // It's also a key combination
- key |= ducky_get_keycode(bad_kb, line_tmp + offset, true);
- }
- }
- if(bad_kb->bt) {
- ble_profile_hid_kb_press(bad_kb->app->ble_hid, key);
- furi_delay_ms(bt_timeout);
- ble_profile_hid_kb_release(bad_kb->app->ble_hid, key);
- } else {
- furi_hal_hid_kb_press(key);
- furi_hal_hid_kb_release(key);
- }
- return 0;
- }
- static bool ducky_set_usb_id(BadKbScript* bad_kb, const char* line) {
- FuriHalUsbHidConfig* cfg = &bad_kb->app->id_config.usb;
- if(sscanf(line, "%lX:%lX", &cfg->vid, &cfg->pid) == 2) {
- cfg->manuf[0] = '\0';
- cfg->product[0] = '\0';
- uint8_t id_len = ducky_get_command_len(line);
- if(!ducky_is_line_end(line[id_len + 1])) {
- sscanf(&line[id_len + 1], "%31[^\r\n:]:%31[^\r\n]", cfg->manuf, cfg->product);
- }
- FURI_LOG_D(
- WORKER_TAG,
- "set usb id: %04lX:%04lX mfr:%s product:%s",
- cfg->vid,
- cfg->pid,
- cfg->manuf,
- cfg->product);
- return true;
- }
- return false;
- }
- static bool ducky_set_bt_id(BadKbScript* bad_kb, const char* line) {
- BadKbConfig* cfg = &bad_kb->app->id_config;
- size_t line_len = strlen(line);
- size_t mac_len = sizeof(cfg->ble.mac) * 3; // 2 text chars + separator per byte
- if(line_len < mac_len + 1) return false; // MAC + at least 1 char for name
- for(size_t i = 0; i < sizeof(cfg->ble.mac); i++) {
- char a = line[i * 3];
- char b = line[i * 3 + 1];
- if((a < 'A' && a > 'F') || (a < '0' && a > '9') || (b < 'A' && b > 'F') ||
- (b < '0' && b > '9') || !hex_char_to_uint8(a, b, &cfg->ble.mac[i])) {
- return false;
- }
- }
- furi_hal_bt_reverse_mac_addr(cfg->ble.mac);
- strlcpy(cfg->ble.name, line + mac_len, sizeof(cfg->ble.name));
- FURI_LOG_D(WORKER_TAG, "set bt id: %s", line);
- return true;
- }
- static void ducky_script_preload(BadKbScript* bad_kb, File* script_file) {
- BadKbApp* app = bad_kb->app;
- uint8_t ret = 0;
- uint32_t line_len = 0;
- furi_string_reset(bad_kb->line);
- do {
- ret = storage_file_read(script_file, bad_kb->file_buf, FILE_BUFFER_LEN);
- for(uint16_t i = 0; i < ret; i++) {
- if(bad_kb->file_buf[i] == '\n' && line_len > 0) {
- bad_kb->st.line_nb++;
- line_len = 0;
- } else {
- if(bad_kb->st.line_nb == 0) { // Save first line
- furi_string_push_back(bad_kb->line, bad_kb->file_buf[i]);
- }
- line_len++;
- }
- }
- if(storage_file_eof(script_file)) {
- if(line_len > 0) {
- bad_kb->st.line_nb++;
- break;
- }
- }
- } while(ret > 0);
- // Looking for ID or BT_ID command at first line
- const char* line_tmp = furi_string_get_cstr(bad_kb->line);
- app->set_usb_id = false;
- app->set_bt_id = false;
- app->has_usb_id = strncmp(line_tmp, ducky_cmd_id, strlen(ducky_cmd_id)) == 0;
- app->has_bt_id = strncmp(line_tmp, ducky_cmd_bt_id, strlen(ducky_cmd_bt_id)) == 0;
- if(app->has_usb_id) {
- //app->is_bt = false;
- app->set_usb_id = ducky_set_usb_id(bad_kb, &line_tmp[strlen(ducky_cmd_id) + 1]);
- } else if(app->has_bt_id) {
- //app->is_bt = true;
- app->set_bt_id = ducky_set_bt_id(bad_kb, &line_tmp[strlen(ducky_cmd_bt_id) + 1]);
- }
- storage_file_seek(script_file, 0, true);
- furi_string_reset(bad_kb->line);
- }
- static int32_t ducky_script_execute_next(BadKbScript* bad_kb, File* script_file) {
- int32_t delay_val = 0;
- if(bad_kb->repeat_cnt > 0) {
- bad_kb->repeat_cnt--;
- delay_val = ducky_parse_line(bad_kb, bad_kb->line_prev);
- if(delay_val == SCRIPT_STATE_NEXT_LINE) { // Empty line
- return 0;
- } else if(delay_val == SCRIPT_STATE_STRING_START) { // Print string with delays
- return delay_val;
- } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // wait for button
- return delay_val;
- } else if(delay_val < 0) { // Script error
- bad_kb->st.error_line = bad_kb->st.line_cur - 1;
- FURI_LOG_E(WORKER_TAG, "Unknown command at line %zu", bad_kb->st.line_cur - 1U);
- return SCRIPT_STATE_ERROR;
- } else {
- return (delay_val + bad_kb->defdelay);
- }
- }
- furi_string_set(bad_kb->line_prev, bad_kb->line);
- furi_string_reset(bad_kb->line);
- while(1) {
- if(bad_kb->buf_len == 0) {
- bad_kb->buf_len = storage_file_read(script_file, bad_kb->file_buf, FILE_BUFFER_LEN);
- if(storage_file_eof(script_file)) {
- if((bad_kb->buf_len < FILE_BUFFER_LEN) && (bad_kb->file_end == false)) {
- bad_kb->file_buf[bad_kb->buf_len] = '\n';
- bad_kb->buf_len++;
- bad_kb->file_end = true;
- }
- }
- bad_kb->buf_start = 0;
- if(bad_kb->buf_len == 0) return SCRIPT_STATE_END;
- }
- for(uint8_t i = bad_kb->buf_start; i < (bad_kb->buf_start + bad_kb->buf_len); i++) {
- if(bad_kb->file_buf[i] == '\n' && furi_string_size(bad_kb->line) > 0) {
- bad_kb->st.line_cur++;
- bad_kb->buf_len = bad_kb->buf_len + bad_kb->buf_start - (i + 1);
- bad_kb->buf_start = i + 1;
- furi_string_trim(bad_kb->line);
- delay_val = ducky_parse_line(bad_kb, bad_kb->line);
- if(delay_val == SCRIPT_STATE_NEXT_LINE) { // Empty line
- return 0;
- } else if(delay_val == SCRIPT_STATE_STRING_START) { // Print string with delays
- return delay_val;
- } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // wait for button
- return delay_val;
- } else if(delay_val < 0) {
- bad_kb->st.error_line = bad_kb->st.line_cur;
- FURI_LOG_E(WORKER_TAG, "Unknown command at line %zu", bad_kb->st.line_cur);
- return SCRIPT_STATE_ERROR;
- } else {
- return (delay_val + bad_kb->defdelay);
- }
- } else {
- furi_string_push_back(bad_kb->line, bad_kb->file_buf[i]);
- }
- }
- bad_kb->buf_len = 0;
- if(bad_kb->file_end) return SCRIPT_STATE_END;
- }
- return 0;
- }
- void bad_kb_bt_hid_state_callback(BtStatus status, void* context) {
- furi_assert(context);
- BadKbScript* bad_kb = context;
- bool state = (status == BtStatusConnected);
- if(state == true) {
- LevelRssiRange r = bt_remote_rssi_range(bad_kb->bt);
- if(r != LevelRssiError) {
- bt_timeout = bt_hid_delays[r];
- }
- furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtConnect);
- } else {
- furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtDisconnect);
- }
- }
- void bad_kb_usb_hid_state_callback(bool state, void* context) {
- furi_assert(context);
- BadKbScript* bad_kb = context;
- if(state == true) {
- furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtConnect);
- } else {
- furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtDisconnect);
- }
- }
- static uint32_t bad_kb_flags_get(uint32_t flags_mask, uint32_t timeout) {
- uint32_t flags = furi_thread_flags_get();
- furi_check((flags & FuriFlagError) == 0);
- if(flags == 0) {
- flags = furi_thread_flags_wait(flags_mask, FuriFlagWaitAny, timeout);
- furi_check(((flags & FuriFlagError) == 0) || (flags == (unsigned)FuriFlagErrorTimeout));
- } else {
- uint32_t state = furi_thread_flags_clear(flags);
- furi_check((state & FuriFlagError) == 0);
- }
- return flags;
- }
- static int32_t bad_kb_worker(void* context) {
- BadKbScript* bad_kb = context;
- BadKbWorkerState worker_state = BadKbStateInit;
- BadKbWorkerState pause_state = BadKbStateRunning;
- int32_t delay_val = 0;
- FURI_LOG_I(WORKER_TAG, "Init");
- File* script_file = storage_file_alloc(furi_record_open(RECORD_STORAGE));
- bad_kb->line = furi_string_alloc();
- bad_kb->line_prev = furi_string_alloc();
- bad_kb->string_print = furi_string_alloc();
- bad_kb->st.elapsed = 0;
- while(1) {
- uint32_t start = furi_get_tick();
- if(worker_state == BadKbStateInit) { // State: initialization
- start = 0;
- FURI_LOG_D(WORKER_TAG, "init start");
- if(storage_file_open(
- script_file,
- furi_string_get_cstr(bad_kb->file_path),
- FSAM_READ,
- FSOM_OPEN_EXISTING)) {
- ducky_script_preload(bad_kb, script_file);
- if(bad_kb->st.line_nb > 0) {
- bad_kb_config_refresh(bad_kb->app);
- worker_state = BadKbStateNotConnected; // Refresh will set connected flag
- } else {
- worker_state = BadKbStateScriptError; // Script preload error
- }
- } else {
- FURI_LOG_E(WORKER_TAG, "File open error");
- worker_state = BadKbStateFileError; // File open error
- }
- bad_kb->st.state = worker_state;
- FURI_LOG_D(WORKER_TAG, "init done");
- } else if(worker_state == BadKbStateNotConnected) { // State: Not connected
- start = 0;
- FURI_LOG_D(WORKER_TAG, "not connected wait");
- uint32_t flags = bad_kb_flags_get(
- WorkerEvtEnd | WorkerEvtConnect | WorkerEvtDisconnect | WorkerEvtStartStop,
- FuriWaitForever);
- FURI_LOG_D(WORKER_TAG, "not connected flags: %lu", flags);
- if(flags & WorkerEvtEnd) {
- break;
- } else if(flags & WorkerEvtConnect) {
- worker_state = BadKbStateIdle; // Ready to run
- } else if(flags & WorkerEvtStartStop) {
- worker_state = BadKbStateWillRun; // Will run when connected
- }
- bad_kb->st.state = worker_state;
- } else if(worker_state == BadKbStateIdle) { // State: ready to start
- start = 0;
- FURI_LOG_D(WORKER_TAG, "idle wait");
- uint32_t flags = bad_kb_flags_get(
- WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtConnect | WorkerEvtDisconnect,
- FuriWaitForever);
- FURI_LOG_D(WORKER_TAG, "idle flags: %lu", flags);
- if(flags & WorkerEvtEnd) {
- break;
- } else if(flags & WorkerEvtStartStop) { // Start executing script
- //dolphin_deed(DolphinDeedBadKbPlayScript);
- delay_val = 0;
- bad_kb->buf_len = 0;
- bad_kb->st.line_cur = 0;
- bad_kb->defdelay = 0;
- bad_kb->stringdelay = 0;
- bad_kb->repeat_cnt = 0;
- bad_kb->key_hold_nb = 0;
- bad_kb->file_end = false;
- storage_file_seek(script_file, 0, true);
- bad_kb_script_set_keyboard_layout(bad_kb, bad_kb->keyboard_layout);
- worker_state = BadKbStateRunning;
- bad_kb->st.elapsed = 0;
- } else if(flags & WorkerEvtDisconnect) {
- worker_state = BadKbStateNotConnected; // Disconnected
- }
- bad_kb->st.state = worker_state;
- } else if(worker_state == BadKbStateWillRun) { // State: start on connection
- start = 0;
- FURI_LOG_D(WORKER_TAG, "will run wait");
- uint32_t flags = bad_kb_flags_get(
- WorkerEvtEnd | WorkerEvtConnect | WorkerEvtDisconnect | WorkerEvtStartStop,
- FuriWaitForever);
- FURI_LOG_D(WORKER_TAG, "will run flags: %lu", flags);
- if(flags & WorkerEvtEnd) {
- break;
- } else if(flags & WorkerEvtConnect) { // Start executing script
- //dolphin_deed(DolphinDeedBadKbPlayScript);
- delay_val = 0;
- bad_kb->buf_len = 0;
- bad_kb->st.line_cur = 0;
- bad_kb->defdelay = 0;
- bad_kb->stringdelay = 0;
- bad_kb->repeat_cnt = 0;
- bad_kb->file_end = false;
- storage_file_seek(script_file, 0, true);
- // extra time for PC to recognize Flipper as keyboard
- flags = furi_thread_flags_wait(
- WorkerEvtEnd | WorkerEvtDisconnect | WorkerEvtStartStop,
- FuriFlagWaitAny | FuriFlagNoClear,
- bad_kb->bt ? 3000 : 1500);
- if(flags == (unsigned)FuriFlagErrorTimeout) {
- // If nothing happened - start script execution
- worker_state = BadKbStateRunning;
- bad_kb->st.elapsed = 0;
- } else if(flags & WorkerEvtStartStop) {
- worker_state = BadKbStateIdle;
- furi_thread_flags_clear(WorkerEvtStartStop);
- }
- if(bad_kb->bt) {
- update_bt_timeout(bad_kb->bt);
- }
- bad_kb_script_set_keyboard_layout(bad_kb, bad_kb->keyboard_layout);
- } else if(flags & WorkerEvtStartStop) { // Cancel scheduled execution
- worker_state = BadKbStateNotConnected;
- }
- bad_kb->st.state = worker_state;
- } else if(worker_state == BadKbStateRunning) { // State: running
- FURI_LOG_D(WORKER_TAG, "running");
- uint16_t delay_cur = (delay_val > 100) ? (100) : (delay_val);
- uint32_t flags = furi_thread_flags_wait(
- WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
- WorkerEvtDisconnect,
- FuriFlagWaitAny,
- delay_cur);
- FURI_LOG_D(WORKER_TAG, "running flags: %lu", flags);
- delay_val -= delay_cur;
- if(!(flags & FuriFlagError)) {
- if(flags & WorkerEvtEnd) {
- break;
- } else if(flags & WorkerEvtStartStop) {
- worker_state = BadKbStateIdle; // Stop executing script
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- } else if(flags & WorkerEvtDisconnect) {
- worker_state = BadKbStateNotConnected; // Disconnected
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- } else if(flags & WorkerEvtPauseResume) {
- pause_state = BadKbStateRunning;
- worker_state = BadKbStatePaused; // Pause
- }
- bad_kb->st.state = worker_state;
- bad_kb->st.elapsed += (furi_get_tick() - start);
- continue;
- } else if(
- (flags == (unsigned)FuriFlagErrorTimeout) ||
- (flags == (unsigned)FuriFlagErrorResource)) {
- if(delay_val > 0) {
- bad_kb->st.delay_remain--;
- bad_kb->st.elapsed += (furi_get_tick() - start);
- continue;
- }
- bad_kb->st.state = BadKbStateRunning;
- delay_val = ducky_script_execute_next(bad_kb, script_file);
- if(delay_val == SCRIPT_STATE_ERROR) { // Script error
- delay_val = 0;
- worker_state = BadKbStateScriptError;
- bad_kb->st.state = worker_state;
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- } else if(delay_val == SCRIPT_STATE_END) { // End of script
- delay_val = 0;
- worker_state = BadKbStateIdle;
- bad_kb->st.state = BadKbStateDone;
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- bad_kb->st.elapsed += (furi_get_tick() - start);
- continue;
- } else if(delay_val == SCRIPT_STATE_STRING_START) { // Start printing string with delays
- delay_val = bad_kb->defdelay;
- bad_kb->string_print_pos = 0;
- worker_state = BadKbStateStringDelay;
- } else if(delay_val == SCRIPT_STATE_WAIT_FOR_BTN) { // set state to wait for user input
- worker_state = BadKbStateWaitForBtn;
- bad_kb->st.state = BadKbStateWaitForBtn; // Show long delays
- } else if(delay_val > 100) {
- bad_kb->st.state = BadKbStateDelay; // Show long delays
- bad_kb->st.delay_remain = delay_val / 100;
- }
- } else {
- furi_check((flags & FuriFlagError) == 0);
- }
- } else if(worker_state == BadKbStateWaitForBtn) { // State: Wait for button Press
- start = 0;
- FURI_LOG_D(WORKER_TAG, "button wait");
- uint32_t flags = bad_kb_flags_get(
- WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
- WorkerEvtDisconnect,
- FuriWaitForever);
- FURI_LOG_D(WORKER_TAG, "button flags: %lu", flags);
- if(!(flags & FuriFlagError)) {
- if(flags & WorkerEvtEnd) {
- break;
- } else if(flags & WorkerEvtStartStop) {
- delay_val = 0;
- worker_state = BadKbStateRunning;
- } else if(flags & WorkerEvtDisconnect) {
- worker_state = BadKbStateNotConnected; // Disconnected
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- }
- bad_kb->st.state = worker_state;
- continue;
- }
- } else if(worker_state == BadKbStatePaused) { // State: Paused
- start = 0;
- FURI_LOG_D(WORKER_TAG, "paused wait");
- uint32_t flags = bad_kb_flags_get(
- WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
- WorkerEvtDisconnect,
- FuriWaitForever);
- FURI_LOG_D(WORKER_TAG, "paused flags: %lu", flags);
- if(!(flags & FuriFlagError)) {
- if(flags & WorkerEvtEnd) {
- break;
- } else if(flags & WorkerEvtStartStop) {
- worker_state = BadKbStateIdle; // Stop executing script
- bad_kb->st.state = worker_state;
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- } else if(flags & WorkerEvtDisconnect) {
- worker_state = BadKbStateNotConnected; // Disconnected
- bad_kb->st.state = worker_state;
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- } else if(flags & WorkerEvtPauseResume) {
- if(pause_state == BadKbStateRunning) {
- if(delay_val > 0) {
- bad_kb->st.state = BadKbStateDelay;
- bad_kb->st.delay_remain = delay_val / 100;
- } else {
- bad_kb->st.state = BadKbStateRunning;
- delay_val = 0;
- }
- worker_state = BadKbStateRunning; // Resume
- } else if(pause_state == BadKbStateStringDelay) {
- bad_kb->st.state = BadKbStateRunning;
- worker_state = BadKbStateStringDelay; // Resume
- }
- }
- continue;
- }
- } else if(worker_state == BadKbStateStringDelay) { // State: print string with delays
- FURI_LOG_D(WORKER_TAG, "delay wait");
- uint32_t flags = bad_kb_flags_get(
- WorkerEvtEnd | WorkerEvtStartStop | WorkerEvtPauseResume | WorkerEvtConnect |
- WorkerEvtDisconnect,
- bad_kb->stringdelay);
- FURI_LOG_D(WORKER_TAG, "delay flags: %lu", flags);
- if(!(flags & FuriFlagError)) {
- if(flags & WorkerEvtEnd) {
- break;
- } else if(flags & WorkerEvtStartStop) {
- worker_state = BadKbStateIdle; // Stop executing script
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- } else if(flags & WorkerEvtDisconnect) {
- worker_state = BadKbStateNotConnected; // Disconnected
- if(bad_kb->bt) {
- ble_profile_hid_kb_release_all(bad_kb->app->ble_hid);
- } else {
- furi_hal_hid_kb_release_all();
- }
- } else if(flags & WorkerEvtPauseResume) {
- pause_state = BadKbStateStringDelay;
- worker_state = BadKbStatePaused; // Pause
- }
- bad_kb->st.state = worker_state;
- bad_kb->st.elapsed += (furi_get_tick() - start);
- continue;
- } else if(
- (flags == (unsigned)FuriFlagErrorTimeout) ||
- (flags == (unsigned)FuriFlagErrorResource)) {
- bool string_end = ducky_string_next(bad_kb);
- if(string_end) {
- bad_kb->stringdelay = 0;
- worker_state = BadKbStateRunning;
- }
- } else {
- furi_check((flags & FuriFlagError) == 0);
- }
- } else if(
- (worker_state == BadKbStateFileError) ||
- (worker_state == BadKbStateScriptError)) { // State: error
- start = 0;
- FURI_LOG_D(WORKER_TAG, "error wait");
- uint32_t flags =
- bad_kb_flags_get(WorkerEvtEnd, FuriWaitForever); // Waiting for exit command
- FURI_LOG_D(WORKER_TAG, "error flags: %lu", flags);
- if(flags & WorkerEvtEnd) {
- break;
- }
- }
- if(bad_kb->bt) {
- update_bt_timeout(bad_kb->bt);
- }
- if(start) {
- bad_kb->st.elapsed += (furi_get_tick() - start);
- }
- }
- bt_set_status_changed_callback(bad_kb->app->bt, NULL, NULL);
- furi_hal_hid_set_state_callback(NULL, NULL);
- storage_file_close(script_file);
- storage_file_free(script_file);
- furi_string_free(bad_kb->line);
- furi_string_free(bad_kb->line_prev);
- furi_string_free(bad_kb->string_print);
- FURI_LOG_I(WORKER_TAG, "End");
- return 0;
- }
- static void bad_kb_script_set_default_keyboard_layout(BadKbScript* bad_kb) {
- furi_assert(bad_kb);
- furi_string_set_str(bad_kb->keyboard_layout, "");
- memset(bad_kb->layout, HID_KEYBOARD_NONE, sizeof(bad_kb->layout));
- memcpy(bad_kb->layout, hid_asciimap, MIN(sizeof(hid_asciimap), sizeof(bad_kb->layout)));
- }
- BadKbScript* bad_kb_script_open(FuriString* file_path, Bt* bt, BadKbApp* app) {
- furi_assert(file_path);
- BadKbScript* bad_kb = malloc(sizeof(BadKbScript));
- bad_kb->app = app;
- bad_kb->file_path = furi_string_alloc();
- furi_string_set(bad_kb->file_path, file_path);
- bad_kb->keyboard_layout = furi_string_alloc();
- bad_kb_script_set_default_keyboard_layout(bad_kb);
- bad_kb->st.state = BadKbStateInit;
- bad_kb->st.error[0] = '\0';
- bad_kb->st.is_bt = !!bt;
- bad_kb->bt = bt;
- bad_kb->thread = furi_thread_alloc_ex("BadKbWorker", 2048, bad_kb_worker, bad_kb);
- furi_thread_start(bad_kb->thread);
- return bad_kb;
- } //-V773
- void bad_kb_script_close(BadKbScript* bad_kb) {
- furi_assert(bad_kb);
- furi_record_close(RECORD_STORAGE);
- furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtEnd);
- furi_thread_join(bad_kb->thread);
- furi_thread_free(bad_kb->thread);
- furi_string_free(bad_kb->file_path);
- furi_string_free(bad_kb->keyboard_layout);
- free(bad_kb);
- }
- void bad_kb_script_set_keyboard_layout(BadKbScript* bad_kb, FuriString* layout_path) {
- furi_assert(bad_kb);
- if((bad_kb->st.state == BadKbStateRunning) || (bad_kb->st.state == BadKbStateDelay)) {
- // do not update keyboard layout while a script is running
- return;
- }
- File* layout_file = storage_file_alloc(furi_record_open(RECORD_STORAGE));
- if(!furi_string_empty(layout_path)) { //-V1051
- furi_string_set(bad_kb->keyboard_layout, layout_path);
- if(storage_file_open(
- layout_file, furi_string_get_cstr(layout_path), FSAM_READ, FSOM_OPEN_EXISTING)) {
- uint16_t layout[128];
- if(storage_file_read(layout_file, layout, sizeof(layout)) == sizeof(layout)) {
- memcpy(bad_kb->layout, layout, sizeof(layout));
- }
- }
- storage_file_close(layout_file);
- } else {
- bad_kb_script_set_default_keyboard_layout(bad_kb);
- }
- storage_file_free(layout_file);
- }
- void bad_kb_script_start_stop(BadKbScript* bad_kb) {
- furi_assert(bad_kb);
- furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtStartStop);
- }
- void bad_kb_script_pause_resume(BadKbScript* bad_kb) {
- furi_assert(bad_kb);
- furi_thread_flags_set(furi_thread_get_id(bad_kb->thread), WorkerEvtPauseResume);
- }
- BadKbState* bad_kb_script_get_state(BadKbScript* bad_kb) {
- furi_assert(bad_kb);
- return &(bad_kb->st);
- }
|