From adccbf1da64da792a14e84af183b3d1e783e6b99 Mon Sep 17 00:00:00 2001
From: Alberto Nidasio <alberto.nidasio@skywarder.eu>
Date: Sat, 10 Sep 2022 15:11:08 +0000
Subject: [PATCH] [Radio] Temperature are now in Celsius in telemetry
---
src/boards/Main/Radio/Radio.cpp | 2 ++
src/boards/Main/TMRepository/TMRepository.cpp | 6 +++---
2 files changed, 5 insertions(+), 3 deletions(-)
diff --git a/src/boards/Main/Radio/Radio.cpp b/src/boards/Main/Radio/Radio.cpp
index d5c272df4..71926fbfd 100644
--- a/src/boards/Main/Radio/Radio.cpp
+++ b/src/boards/Main/Radio/Radio.cpp
@@ -344,6 +344,8 @@ void Radio::handleMavlinkMessage(MavDriver* driver,
float temperature =
mavlink_msg_set_reference_temperature_tc_get_ref_temp(&msg);
+ temperature += 273.15;
+
NASController::getInstance().setReferenceTemperature(temperature);
ADAController::getInstance().setReferenceTemperature(temperature);
break;
diff --git a/src/boards/Main/TMRepository/TMRepository.cpp b/src/boards/Main/TMRepository/TMRepository.cpp
index 4d4e03a05..e2194245c 100644
--- a/src/boards/Main/TMRepository/TMRepository.cpp
+++ b/src/boards/Main/TMRepository/TMRepository.cpp
@@ -162,10 +162,10 @@ mavlink_message_t TMRepository::packSystemTm(SystemTMList tmId, uint8_t msgId,
tm.vertical_speed = state.verticalSpeed;
tm.ref_altitude = ref.refAltitude;
tm.ref_pressure = ref.refPressure;
- tm.ref_temperature = ref.refTemperature;
+ tm.ref_temperature = ref.refTemperature - 273.15;
tm.msl_altitude = state.mslAltitude;
tm.msl_pressure = ref.mslPressure;
- tm.msl_temperature = ref.mslTemperature;
+ tm.msl_temperature = ref.mslTemperature - 273.15;
tm.dpl_altitude = ada.getDeploymentAltitude();
mavlink_msg_ada_tm_encode(RadioConfig::MAV_SYSTEM_ID,
@@ -197,7 +197,7 @@ mavlink_message_t TMRepository::packSystemTm(SystemTMList tmId, uint8_t msgId,
tm.nas_bias_y = state.by;
tm.nas_bias_z = state.bz;
tm.ref_pressure = ref.refPressure;
- tm.ref_temperature = ref.refTemperature;
+ tm.ref_temperature = ref.refTemperature - 273.15;
tm.ref_latitude = ref.refLatitude;
tm.ref_longitude = ref.refLongitude;
--
GitLab