uart.c 6.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196
  1. #include "uart.h"
  2. #define UART_CH (FuriHalSerialIdUsart)
  3. #define LP_UART_CH (FuriHalSerialIdLpuart)
  4. #define BAUDRATE (115200UL)
  5. struct Uart {
  6. void* app;
  7. FuriThread* rx_thread;
  8. FuriHalSerialHandle* serial_handle;
  9. FuriHalSerialId channel;
  10. FuriThread* worker_thread;
  11. FuriStreamBuffer* rx_stream;
  12. uint8_t rx_buf[RX_BUF_SIZE + 1];
  13. void (*handle_rx_data_cb)(uint8_t* buf, size_t len, void* context);
  14. };
  15. typedef enum {
  16. WorkerEvtStop = (1 << 0),
  17. WorkerEvtRxDone = (1 << 1),
  18. } WorkerEventFlags;
  19. #define WORKER_ALL_RX_EVENTS (WorkerEvtStop | WorkerEvtRxDone)
  20. void uart_set_handle_rx_data_cb(
  21. Uart* uart,
  22. void (*handle_rx_data_cb)(uint8_t* buf, size_t len, void* context)) {
  23. furi_assert(uart);
  24. uart->handle_rx_data_cb = handle_rx_data_cb;
  25. }
  26. static void wifi_marauder_uart_on_irq_cb(
  27. FuriHalSerialHandle* handle,
  28. FuriHalSerialRxEvent event,
  29. void* context) {
  30. Uart* uart = (Uart*)context;
  31. if(event == FuriHalSerialRxEventData) {
  32. uint8_t data = furi_hal_serial_async_rx(handle);
  33. furi_stream_buffer_send(uart->rx_stream, &data, 1, 0);
  34. furi_thread_flags_set(furi_thread_get_id(uart->rx_thread), WorkerEvtRxDone);
  35. }
  36. }
  37. static void uart_on_irq_cb(FuriHalSerialHandle* handle, FuriHalSerialRxEvent event, void* context) {
  38. Uart* uart = (Uart*)context;
  39. UNUSED(handle);
  40. if(event & (FuriHalSerialRxEventData | FuriHalSerialRxEventIdle)) {
  41. uint8_t data = furi_hal_serial_async_rx(handle);
  42. furi_stream_buffer_send(uart->rx_stream, &data, 1, 0);
  43. furi_thread_flags_set(furi_thread_get_id(uart->rx_thread), WorkerEvtRxDone);
  44. }
  45. }
  46. // Define una constante para el prefijo que estamos buscando
  47. #define JSON_PREFIX "JSON:"
  48. // Variables globales
  49. static char json_buffer[2048]; // Ajusta el tamaño según tus necesidades
  50. static size_t json_buffer_index = 0;
  51. static bool json_capture_active = false;
  52. // static bool json_finded = false;
  53. // Prototipo de la función
  54. // static void process_json_buffer();
  55. static void process_json_buffer(void* context) {
  56. Uart* uart = (Uart*)context;
  57. // Agregamos el terminador nulo al final del buffer
  58. json_buffer[json_buffer_index] = '\0';
  59. if(uart->handle_rx_data_cb) {
  60. uart->handle_rx_data_cb((uint8_t*)json_buffer, json_buffer_index, uart->app);
  61. memset(json_buffer, 0, sizeof(json_buffer));
  62. }
  63. // Reiniciamos el buffer
  64. json_buffer_index = 0;
  65. }
  66. static void uart_echo_push_to_list(void* context, uint8_t data) {
  67. Uart* uart = (Uart*)context;
  68. if(!json_capture_active) {
  69. if(data == JSON_PREFIX[json_buffer_index]) {
  70. json_buffer[json_buffer_index++] = data; // Agregar el carácter al buffer
  71. if(json_buffer_index == strlen(JSON_PREFIX)) {
  72. // Encontramos el prefijo, comenzamos a capturar
  73. json_buffer_index = 0;
  74. json_capture_active = true;
  75. }
  76. } else {
  77. // Reiniciamos el índice si no coincide con el prefijo
  78. json_buffer_index = 0;
  79. }
  80. } else {
  81. // Capturamos caracteres hasta encontrar '\n'
  82. json_buffer[json_buffer_index++] = data;
  83. if(data == '\n') {
  84. // Terminamos de capturar la línea, procesamos el buffer
  85. json_capture_active = false;
  86. process_json_buffer(uart);
  87. }
  88. }
  89. }
  90. static int32_t uart_worker(void* context) {
  91. furi_assert(context);
  92. Uart* uart = (Uart*)context;
  93. while(1) {
  94. uint32_t events =
  95. furi_thread_flags_wait(WORKER_ALL_RX_EVENTS, FuriFlagWaitAny, FuriWaitForever);
  96. furi_check((events & FuriFlagError) == 0);
  97. if(events & WorkerEvtStop) break;
  98. if(events & WorkerEvtRxDone) {
  99. if(uart->channel == UART_CH) {
  100. size_t length = 0;
  101. do {
  102. uint8_t data[64];
  103. length = furi_stream_buffer_receive(uart->rx_stream, data, 64, 0);
  104. if(length > 0) {
  105. for(size_t i = 0; i < length; i++) {
  106. uart_echo_push_to_list(uart, data[i]);
  107. // FURI_LOG_I("UART", "[in]: %c - %d", (const char)data[i], data[i]);
  108. }
  109. }
  110. } while(length > 0);
  111. } else if(uart->channel == LP_UART_CH) {
  112. size_t len =
  113. furi_stream_buffer_receive(uart->rx_stream, uart->rx_buf, RX_BUF_SIZE, 0);
  114. if(len > 0) {
  115. if(uart->handle_rx_data_cb)
  116. uart->handle_rx_data_cb(uart->rx_buf, len, uart->app);
  117. }
  118. }
  119. }
  120. }
  121. furi_stream_buffer_free(uart->rx_stream);
  122. return 0;
  123. }
  124. void uart_tx(void* app, uint8_t* data, size_t len) {
  125. Uart* uart = (Uart*)app;
  126. furi_hal_serial_tx(uart->serial_handle, data, len);
  127. }
  128. Uart* _uart_init(void* app, FuriHalSerialId channel, const char* thread_name) {
  129. Uart* uart = (Uart*)malloc(sizeof(Uart));
  130. uart->app = app;
  131. uart->channel = channel;
  132. uart->rx_stream = furi_stream_buffer_alloc(RX_BUF_SIZE, 1);
  133. uart->rx_thread = furi_thread_alloc();
  134. furi_thread_set_name(uart->rx_thread, thread_name);
  135. furi_thread_set_stack_size(uart->rx_thread, 1024);
  136. furi_thread_set_context(uart->rx_thread, uart);
  137. furi_thread_set_callback(uart->rx_thread, uart_worker);
  138. furi_thread_start(uart->rx_thread);
  139. uart->serial_handle = furi_hal_serial_control_acquire(channel);
  140. if(!uart->serial_handle) {
  141. furi_delay_ms(5000);
  142. }
  143. furi_check(uart->serial_handle);
  144. furi_hal_serial_init(uart->serial_handle, BAUDRATE);
  145. furi_hal_serial_async_rx_start(
  146. uart->serial_handle,
  147. channel == FuriHalSerialIdUsart ? uart_on_irq_cb : wifi_marauder_uart_on_irq_cb,
  148. uart,
  149. false);
  150. return uart;
  151. }
  152. Uart* usart_init(void* app) {
  153. return _uart_init(app, UART_CH, "UartRxThread");
  154. }
  155. Uart* lp_uart_init(void* app) {
  156. return _uart_init(app, LP_UART_CH, "LPUartRxThread");
  157. }
  158. void uart_free(Uart* uart) {
  159. furi_assert(uart);
  160. furi_thread_flags_set(furi_thread_get_id(uart->rx_thread), WorkerEvtStop);
  161. furi_thread_join(uart->rx_thread);
  162. furi_thread_free(uart->rx_thread);
  163. furi_hal_serial_deinit(uart->serial_handle);
  164. furi_hal_serial_control_release(uart->serial_handle);
  165. free(uart);
  166. }