diff --git a/src/boards/Main/Radio/Radio.cpp b/src/boards/Main/Radio/Radio.cpp
index d5c272df4b2a648e3417d8d3fafd5a0d788df580..71926fbfdd2f9cfcab6100098c30f7483d5c4c7e 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 4d4e03a0510f4602cd5a60be13dcd36005ebdee6..e2194245ce8eda8655aaabeb5df4f701bbe5c8a3 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;