diff --git a/AntennaTracker/Log.cpp b/AntennaTracker/Log.cpp index 5a70a09eb4..9fcb8059db 100644 --- a/AntennaTracker/Log.cpp +++ b/AntennaTracker/Log.cpp @@ -91,6 +91,7 @@ void Tracker::Log_Write_Vehicle_Startup_Messages() { logger.Write_Mode((uint8_t)mode->number(), ModeReason::INITIALISED); gps.Write_AP_Logger_Log_Startup_messages(); + logger.Write_NamedValueFloat("NAV_ALT_OFS", nav_status.altitude_offset); } void Tracker::log_init(void) diff --git a/AntennaTracker/tracking.cpp b/AntennaTracker/tracking.cpp index facd7141b5..872c9d186f 100644 --- a/AntennaTracker/tracking.cpp +++ b/AntennaTracker/tracking.cpp @@ -166,6 +166,9 @@ void Tracker::tracking_update_pressure(const mavlink_scaled_pressure_t &msg) nav_status.altitude_offset = -alt_diff; nav_status.alt_difference_baro = 0; nav_status.need_altitude_calibration = false; +#if HAL_LOGGING_ENABLED + logger.Write_NamedValueFloat("NAV_ALT_OFS", nav_status.altitude_offset); +#endif } }