gps.c 4.0 KB

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