diff --git a/ground_station/src/hmi/window.cpp b/ground_station/src/hmi/window.cpp index cfdb21b0..227b73c8 100644 --- a/ground_station/src/hmi/window.cpp +++ b/ground_station/src/hmi/window.cpp @@ -332,8 +332,8 @@ void Window::UpdateLiveState(TelemetryData *data1, TelemetryData *data2, Navigat float bearing = navigation->computeBearing(); display.setCursor(static_cast(xOffset1 + first_row_offset), 145); - display.print(old_bearing[0]); - display.print(" deg"); + //display.print(old_bearing[0]); + display.print("Coming soon"); old_bearing[0] = bearing; // Set Downrange text of FC 2 to white @@ -351,8 +351,8 @@ void Window::UpdateLiveState(TelemetryData *data1, TelemetryData *data2, Navigat bearing = navigation->computeBearing(); display.setCursor(static_cast(xOffset2 + first_row_offset), 145); - display.print(old_bearing[1]); - display.print(" deg"); + //display.print(old_bearing[1]); + display.print("Coming soon"); old_bearing[1] = bearing; // Set DownRange to white @@ -556,12 +556,12 @@ void Window::updateLiveData(TelemetryData *data, Navigation *navigation, int16_t display.setCursor(static_cast(xOffset + first_row_offset), 145); display.setTextColor(WHITE); - display.print(old_bearing[index]); - display.print(" deg"); + //display.print(old_bearing[index]); + display.print("Coming soon"); display.setTextColor(color); display.setCursor(static_cast(xOffset + first_row_offset), 145); - display.print(bearing); - display.print(" deg"); + //display.print(bearing); + display.print("Coming soon"); old_bearing[index] = bearing; } diff --git a/ground_station/src/navigation.hpp b/ground_station/src/navigation.hpp index 5ffcc815..31c3f60b 100644 --- a/ground_station/src/navigation.hpp +++ b/ground_station/src/navigation.hpp @@ -113,7 +113,7 @@ class Navigation { return elevation; } - inline float computeBearing() { return (azimuth + filter.getYawRadians() - PI_F / 2) / (2 * PI_F / 360); } + inline float computeBearing() const { return (azimuth - PI_F / 2) / (2 * PI_F / 360); } struct mag_calibration_t { float offset[3];