Add extra info from serial (#1754)

* Inject GPS postition from serial

firmware/application/ui/ui_geomap.cpp

@@ -305,6 +305,7 @@ void GeoMap::paint(Painter& painter) {
         // Draw the other markers
         draw_markers(painter);
         draw_scale(painter);
+        draw_mypos();
         markerListUpdated = false;
         set_clean();
     }
@@ -447,6 +448,41 @@ void GeoMap::draw_marker(Painter& painter, const ui::Point itemPoint, const uint
     }
 }
 
+void GeoMap::draw_mypos() {
+    const auto r = screen_rect();
+    if (my_lat >= 200 || my_lon >= 200) return;  // invalid
+    int x = (map_width * (my_lon + 180) / 360) - x_pos;
+    double lat_rad = sin(my_lat * pi / 180);
+    int y = (map_height - ((map_world_lon / 2 * log((1 + lat_rad) / (1 - lat_rad))) - map_offset)) - y_pos;  // Offset added for the GUI
+    auto color = Color::yellow();
+
+    if (map_zoom > 1) {
+        x = ((x - (r.width() / 2)) * map_zoom) + (r.width() / 2);
+        y = ((y - (r.height() / 2)) * map_zoom) + (r.height() / 2);
+    } else if (map_zoom < 0) {
+        x = ((x - (r.width() / 2)) / (-map_zoom)) + (r.width() / 2);
+        y = ((y - (r.height() / 2)) / (-map_zoom)) + (r.height() / 2);
+    }
+
+    if ((x >= 0) && (x < r.width()) &&
+        (y > 10) && (y < r.height()))  // Dont draw within symbol size of top
+    {
+        ui::Point itemPoint(x, y + r.top());
+        if (mode_ == PROMPT) {
+            // Cross
+            display.fill_rectangle({itemPoint - Point(16, 1), {32, 2}}, color);
+            display.fill_rectangle({itemPoint - Point(1, 16), {2, 32}}, color);
+        } else if (my_angle < 360) {
+            // if we have a valid angle draw bearing
+            draw_bearing(itemPoint, my_angle, 10, color);
+        } else {
+            // draw a small cross
+            display.fill_rectangle({itemPoint - Point(8, 1), {16, 2}}, color);
+            display.fill_rectangle({itemPoint - Point(1, 8), {2, 16}}, color);
+        }
+    }
+}
+
 void GeoMap::clear_markers() {
     markerListLen = 0;
 }
@@ -473,6 +509,17 @@ MapMarkerStored GeoMap::store_marker(GeoMarker& marker) {
     return ret;
 }
 
+void GeoMap::update_my_position(float lat, float lon, int32_t altitude) {
+    my_lat = lat;
+    my_lon = lon;
+    my_altitude = altitude;
+    markerListUpdated = true;
+    set_dirty();
+}
+void GeoMap::update_my_orientation(uint16_t angle) {
+    my_angle = angle;
+}
+
 void GeoMapView::focus() {
     geopos.focus();
 
@@ -480,6 +527,13 @@ void GeoMapView::focus() {
         nav_.display_modal("No map", "No world_map.bin file in\n/ADSB/ directory", ABORT);
 }
 
+void GeoMapView::update_my_position(float lat, float lon, int32_t altitude) {
+    geomap.update_my_position(lat, lon, altitude);
+}
+void GeoMapView::update_my_orientation(uint16_t angle) {
+    geomap.update_my_orientation(angle);
+}
+
 void GeoMapView::update_position(float lat, float lon, uint16_t angle, int32_t altitude, int32_t speed) {
     if (geomap.manual_panning()) {
         geomap.set_dirty();

firmware/application/ui/ui_geomap.hpp

@@ -185,6 +185,9 @@ class GeoMap : public Widget {
     bool on_encoder(const EncoderEvent delta) override;
     bool on_keyboard(const KeyboardEvent event) override;
 
+    void update_my_position(float lat, float lon, int32_t altitude);
+    void update_my_orientation(uint16_t angle);
+
     bool init();
     void set_mode(GeoMapMode mode);
     void set_manual_panning(bool v);
@@ -212,6 +215,7 @@ class GeoMap : public Widget {
     void draw_bearing(const Point origin, const uint16_t angle, uint32_t size, const Color color);
     void draw_marker(Painter& painter, const ui::Point itemPoint, const uint16_t itemAngle, const std::string itemTag, const Color color = Color::red(), const Color fontColor = Color::white(), const Color backColor = Color::black());
     void draw_markers(Painter& painter);
+    void draw_mypos();
     void map_read_line(ui::Color* buffer, uint16_t pixels);
 
     bool manual_panning_{false};
@@ -233,6 +237,12 @@ class GeoMap : public Widget {
     uint16_t angle_{};
     std::string tag_{};
 
+    // the portapack's position data ( for example injected from serial )
+    float my_lat{200};
+    float my_lon{200};
+    int32_t my_altitude{0};
+    uint16_t my_angle{400};
+
     int markerListLen{0};
     GeoMarker markerList[NumMarkerListElements];
     bool markerListUpdated{false};
@@ -267,6 +277,8 @@ class GeoMapView : public View {
     void focus() override;
 
     void update_position(float lat, float lon, uint16_t angle, int32_t altitude, int32_t speed = 0);
+    void update_my_position(float lat, float lon, int32_t altitude);
+    void update_my_orientation(uint16_t angle);
 
     std::string title() const override { return "Map view"; };