gps.c 4.1 KB

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