fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-22 04:43:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

TECS: add EAS_sp to tecs_status.msg and rename other airspeeds to TAS

Browse Source 
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer
2021-01-23 09:34:34 -05:00
committed by Daniel Agar
parent 5e32e9be5a
commit 92f2043d8b
5 changed files with 13 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/streams/HIGH_LATENCY2.hpp
+1 -1
View File
@@ -525,7 +525,7 @@ private:
tecs_status_s tecs_status;
if (_tecs_status_sub.update(&tecs_status)) {
_airspeed_sp.add_value(tecs_status.airspeed_sp, _update_rate_filtered);
_airspeed_sp.add_value(tecs_status.true_airspeed_sp, _update_rate_filtered);
}
}
src/modules/mavlink/streams/NAV_CONTROLLER_OUTPUT.hpp
+1 -1
View File
@@ -78,7 +78,7 @@ private:
msg.wp_dist = math::constrain(roundf(pos_ctrl_status.wp_dist), 0.f, (float)UINT16_MAX);
msg.xtrack_error = pos_ctrl_status.xtrack_error;
msg.alt_error = tecs_status.altitude_filtered - tecs_status.altitude_sp;
msg.aspd_error = tecs_status.airspeed_filtered - tecs_status.airspeed_sp;
msg.aspd_error = tecs_status.true_airspeed_filtered - tecs_status.true_airspeed_sp;
mavlink_msg_nav_controller_output_send_struct(_mavlink->get_channel(), &msg);