gps.c 3.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125
  1. #include "gps_uart.h"
  2. #include <furi.h>
  3. #include <gui/gui.h>
  4. #include <string.h>
  5. typedef enum
  6. {
  7. EventTypeTick,
  8. EventTypeKey,
  9. } EventType;
  10. typedef struct
  11. {
  12. EventType type;
  13. InputEvent input;
  14. } PluginEvent;
  15. static void render_callback(Canvas* const canvas, void* context)
  16. {
  17. const GpsUart* gps_uart = acquire_mutex((ValueMutex*)context, 25);
  18. if (gps_uart == NULL)
  19. {
  20. return;
  21. }
  22. canvas_set_font(canvas, FontSecondary);
  23. char buffer[64];
  24. snprintf(buffer, 64, "LAT: %f", (double)gps_uart->status.latitude);
  25. canvas_draw_str_aligned(canvas, 10, 10, AlignLeft, AlignBottom, buffer);
  26. snprintf(buffer, 64, "LON: %f", (double)gps_uart->status.longitude);
  27. canvas_draw_str_aligned(canvas, 10, 20, AlignLeft, AlignBottom, buffer);
  28. snprintf(buffer, 64, "C/S: %.1f / %.2fkn", (double)gps_uart->status.course, (double)gps_uart->status.speed);
  29. canvas_draw_str_aligned(canvas, 10, 30, AlignLeft, AlignBottom, buffer);
  30. snprintf(buffer, 64, "ALT: %.1f %c", (double)gps_uart->status.altitude, gps_uart->status.altitude_units);
  31. canvas_draw_str_aligned(canvas, 10, 40, AlignLeft, AlignBottom, buffer);
  32. snprintf(buffer, 64, "FIX: %d", gps_uart->status.fix_quality);
  33. canvas_draw_str_aligned(canvas, 10, 50, AlignLeft, AlignBottom, buffer);
  34. snprintf(buffer, 64, "SAT: %d", gps_uart->status.satellites_tracked);
  35. canvas_draw_str_aligned(canvas, 10, 60, AlignLeft, AlignBottom, buffer);
  36. release_mutex((ValueMutex*)context, gps_uart);
  37. }
  38. static void input_callback(InputEvent* input_event, FuriMessageQueue* event_queue)
  39. {
  40. furi_assert(event_queue);
  41. PluginEvent event = {.type = EventTypeKey, .input = *input_event};
  42. furi_message_queue_put(event_queue, &event, FuriWaitForever);
  43. }
  44. int32_t gps_app(void* p)
  45. {
  46. UNUSED(p);
  47. FuriMessageQueue* event_queue = furi_message_queue_alloc(8, sizeof(PluginEvent));
  48. GpsUart* gps_uart = gps_uart_enable();
  49. ValueMutex gps_uart_mutex;
  50. if (!init_mutex(&gps_uart_mutex, gps_uart, sizeof(GpsUart)))
  51. {
  52. FURI_LOG_E("GPS", "cannot create mutex\r\n");
  53. free(gps_uart);
  54. return 255;
  55. }
  56. // set system callbacks
  57. ViewPort* view_port = view_port_alloc();
  58. view_port_draw_callback_set(view_port, render_callback, &gps_uart_mutex);
  59. view_port_input_callback_set(view_port, input_callback, event_queue);
  60. // open GUI and register view_port
  61. Gui* gui = furi_record_open("gui");
  62. gui_add_view_port(gui, view_port, GuiLayerFullscreen);
  63. PluginEvent event;
  64. for (bool processing = true; processing;)
  65. {
  66. FuriStatus event_status = furi_message_queue_get(event_queue, &event, 100);
  67. GpsUart* gps_uart = (GpsUart*)acquire_mutex_block(&gps_uart_mutex);
  68. if (event_status == FuriStatusOk)
  69. {
  70. // press events
  71. if (event.type == EventTypeKey)
  72. {
  73. if (event.input.type == InputTypePress)
  74. {
  75. switch (event.input.key)
  76. {
  77. case InputKeyUp:
  78. case InputKeyDown:
  79. case InputKeyRight:
  80. case InputKeyLeft:
  81. case InputKeyOk:
  82. break;
  83. case InputKeyBack:
  84. processing = false;
  85. break;
  86. }
  87. }
  88. }
  89. }
  90. else
  91. {
  92. FURI_LOG_D("GPS", "FuriMessageQueue: event timeout");
  93. }
  94. view_port_update(view_port);
  95. release_mutex(&gps_uart_mutex, gps_uart);
  96. }
  97. view_port_enabled_set(view_port, false);
  98. gui_remove_view_port(gui, view_port);
  99. furi_record_close("gui");
  100. view_port_free(view_port);
  101. furi_message_queue_free(event_queue);
  102. delete_mutex(&gps_uart_mutex);
  103. gps_uart_disable(gps_uart);
  104. return 0;
  105. }