subghz_analyze.c 7.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233
  1. #include "subghz_analyze.h"
  2. #include "../subghz_i.h"
  3. #include <math.h>
  4. #include <furi.h>
  5. #include <furi-hal.h>
  6. #include <input/input.h>
  7. #include <gui/elements.h>
  8. #include <notification/notification-messages.h>
  9. #include <lib/subghz/subghz_worker.h>
  10. #include <lib/subghz/protocols/subghz_protocol.h>
  11. #include <assets_icons.h>
  12. struct SubghzAnalyze {
  13. View* view;
  14. SubGhzWorker* worker;
  15. SubGhzProtocol* protocol;
  16. };
  17. typedef struct {
  18. uint8_t frequency;
  19. uint32_t real_frequency;
  20. uint32_t counter;
  21. string_t text;
  22. uint16_t scene;
  23. SubGhzProtocolCommon parser;
  24. } SubghzAnalyzeModel;
  25. static const char subghz_symbols[] = {'-', '\\', '|', '/'};
  26. void subghz_analyze_draw(Canvas* canvas, SubghzAnalyzeModel* model) {
  27. char buffer[64];
  28. canvas_set_color(canvas, ColorBlack);
  29. canvas_set_font(canvas, FontPrimary);
  30. snprintf(
  31. buffer,
  32. sizeof(buffer),
  33. "Analyze: %03ld.%03ldMHz %c",
  34. model->real_frequency / 1000000 % 1000,
  35. model->real_frequency / 1000 % 1000,
  36. subghz_symbols[model->counter % 4]);
  37. canvas_draw_str(canvas, 0, 8, buffer);
  38. switch(model->scene) {
  39. case 1:
  40. canvas_draw_icon(canvas, 0, 10, &I_RFIDDolphinReceive_97x61);
  41. canvas_invert_color(canvas);
  42. canvas_draw_box(canvas, 80, 12, 20, 20);
  43. canvas_invert_color(canvas);
  44. canvas_draw_icon(canvas, 75, 18, &I_sub1_10px);
  45. elements_multiline_text_aligned(
  46. canvas, 90, 38, AlignCenter, AlignTop, "Detecting\r\nSubGhz");
  47. break;
  48. default:
  49. canvas_set_font(canvas, FontSecondary);
  50. elements_multiline_text(canvas, 0, 20, string_get_cstr(model->text));
  51. break;
  52. }
  53. }
  54. bool subghz_analyze_input(InputEvent* event, void* context) {
  55. furi_assert(context);
  56. SubghzAnalyze* subghz_analyze = context;
  57. if(event->type != InputTypeShort) return false;
  58. if(event->key == InputKeyBack) {
  59. return false;
  60. }
  61. with_view_model(
  62. subghz_analyze->view, (SubghzAnalyzeModel * model) {
  63. bool model_updated = false;
  64. if(event->key == InputKeyLeft) {
  65. if(model->frequency > 0) model->frequency--;
  66. model_updated = true;
  67. } else if(event->key == InputKeyRight) {
  68. if(model->frequency < subghz_frequencies_count - 1) model->frequency++;
  69. model_updated = true;
  70. }
  71. if(model_updated) {
  72. furi_hal_subghz_idle();
  73. model->real_frequency =
  74. furi_hal_subghz_set_frequency_and_path(subghz_frequencies[model->frequency]);
  75. furi_hal_subghz_rx();
  76. }
  77. return model_updated;
  78. });
  79. return true;
  80. }
  81. void subghz_analyze_text_callback(string_t text, void* context) {
  82. furi_assert(context);
  83. SubghzAnalyze* subghz_analyze = context;
  84. with_view_model(
  85. subghz_analyze->view, (SubghzAnalyzeModel * model) {
  86. model->counter++;
  87. string_set(model->text, text);
  88. model->scene = 0;
  89. return true;
  90. });
  91. }
  92. void subghz_analyze_protocol_callback(SubGhzProtocolCommon* parser, void* context) {
  93. furi_assert(context);
  94. SubghzAnalyze* subghz_analyze = context;
  95. char buffer[64];
  96. snprintf(
  97. buffer,
  98. sizeof(buffer),
  99. "%s\r\n"
  100. "K:%lX%lX\r\n"
  101. "SN:%lX\r\n"
  102. "BTN:%X",
  103. parser->name,
  104. (uint32_t)(parser->code_found >> 32),
  105. (uint32_t)(parser->code_found & 0x00000000FFFFFFFF),
  106. parser->serial,
  107. parser->btn);
  108. with_view_model(
  109. subghz_analyze->view, (SubghzAnalyzeModel * model) {
  110. model->counter++;
  111. model->parser = *parser;
  112. string_set(model->text, buffer);
  113. model->scene = 0;
  114. return true;
  115. });
  116. }
  117. void subghz_analyze_enter(void* context) {
  118. furi_assert(context);
  119. SubghzAnalyze* subghz_analyze = context;
  120. furi_hal_subghz_reset();
  121. furi_hal_subghz_idle();
  122. furi_hal_subghz_load_preset(FuriHalSubGhzPresetOokAsync);
  123. with_view_model(
  124. subghz_analyze->view, (SubghzAnalyzeModel * model) {
  125. model->frequency = subghz_frequencies_433_92;
  126. model->real_frequency =
  127. furi_hal_subghz_set_frequency_and_path(subghz_frequencies[model->frequency]);
  128. model->scene = 1;
  129. return true;
  130. });
  131. hal_gpio_init(&gpio_cc1101_g0, GpioModeInput, GpioPullNo, GpioSpeedLow);
  132. furi_hal_subghz_start_async_rx(subghz_worker_rx_callback, subghz_analyze->worker);
  133. subghz_worker_start(subghz_analyze->worker);
  134. furi_hal_subghz_flush_rx();
  135. furi_hal_subghz_rx();
  136. }
  137. void subghz_analyze_exit(void* context) {
  138. furi_assert(context);
  139. SubghzAnalyze* subghz_analyze = context;
  140. subghz_worker_stop(subghz_analyze->worker);
  141. furi_hal_subghz_stop_async_rx();
  142. furi_hal_subghz_sleep();
  143. }
  144. SubghzAnalyze* subghz_analyze_alloc() {
  145. SubghzAnalyze* subghz_analyze = furi_alloc(sizeof(SubghzAnalyze));
  146. // View allocation and configuration
  147. subghz_analyze->view = view_alloc();
  148. view_allocate_model(subghz_analyze->view, ViewModelTypeLocking, sizeof(SubghzAnalyzeModel));
  149. view_set_context(subghz_analyze->view, subghz_analyze);
  150. view_set_draw_callback(subghz_analyze->view, (ViewDrawCallback)subghz_analyze_draw);
  151. view_set_input_callback(subghz_analyze->view, subghz_analyze_input);
  152. view_set_enter_callback(subghz_analyze->view, subghz_analyze_enter);
  153. view_set_exit_callback(subghz_analyze->view, subghz_analyze_exit);
  154. with_view_model(
  155. subghz_analyze->view, (SubghzAnalyzeModel * model) {
  156. string_init(model->text);
  157. return true;
  158. });
  159. subghz_analyze->worker = subghz_worker_alloc();
  160. subghz_analyze->protocol = subghz_protocol_alloc();
  161. subghz_worker_set_overrun_callback(
  162. subghz_analyze->worker, (SubGhzWorkerOverrunCallback)subghz_protocol_reset);
  163. subghz_worker_set_pair_callback(
  164. subghz_analyze->worker, (SubGhzWorkerPairCallback)subghz_protocol_parse);
  165. subghz_worker_set_context(subghz_analyze->worker, subghz_analyze->protocol);
  166. subghz_protocol_load_keeloq_file(
  167. subghz_analyze->protocol, "/ext/assets/subghz/keeloq_mfcodes");
  168. subghz_protocol_load_nice_flor_s_file(
  169. subghz_analyze->protocol, "/ext/assets/subghz/nice_floor_s_rx");
  170. subghz_protocol_enable_dump_text(
  171. subghz_analyze->protocol, subghz_analyze_text_callback, subghz_analyze);
  172. return subghz_analyze;
  173. }
  174. void subghz_analyze_free(SubghzAnalyze* subghz_analyze) {
  175. furi_assert(subghz_analyze);
  176. subghz_protocol_free(subghz_analyze->protocol);
  177. subghz_worker_free(subghz_analyze->worker);
  178. with_view_model(
  179. subghz_analyze->view, (SubghzAnalyzeModel * model) {
  180. string_clear(model->text);
  181. return true;
  182. });
  183. view_free(subghz_analyze->view);
  184. free(subghz_analyze);
  185. }
  186. View* subghz_analyze_get_view(SubghzAnalyze* subghz_analyze) {
  187. furi_assert(subghz_analyze);
  188. return subghz_analyze->view;
  189. }