gps.c 4.2 KB

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