AP_RCTelemetry: Fix Baro and Vario values

Add the missing byte swapping for 16bit values
ArduPilot · Oct 29, 2024 · 4733400 · 4733400
1 parent a6f00a3
commit 4733400
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/libraries/AP_RCTelemetry/AP_CRSF_Telem.cpp b/libraries/AP_RCTelemetry/AP_CRSF_Telem.cpp
@@ -975,7 +975,7 @@ int8_t AP_CRSF_Telem::get_vertical_speed_packed()
 // prepare vario data
 void AP_CRSF_Telem::calc_baro_vario()
 {
-    _telem.bcast.baro_vario.altitude_packed = get_altitude_packed();
+    _telem.bcast.baro_vario.altitude_packed = htobe16(get_altitude_packed());
     _telem.bcast.baro_vario.vertical_speed_packed = get_vertical_speed_packed();
 
     _telem_size = sizeof(BaroVarioFrame);
@@ -987,7 +987,7 @@ void AP_CRSF_Telem::calc_baro_vario()
 // prepare vario data
 void AP_CRSF_Telem::calc_vario()
 {
-    _telem.bcast.vario.v_speed = int16_t(get_vspeed_ms() * 100.0f);
+    _telem.bcast.vario.v_speed = htobe16(int16_t(get_vspeed_ms() * 100.0f));
     _telem_size = sizeof(VarioFrame);
     _telem_type = AP_RCProtocol_CRSF::CRSF_FRAMETYPE_VARIO;