mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-28 22:53:34 +08:00
tecs msg: changed flight_path_angle to height rate as clearly we are
looking at height rates Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
@@ -210,8 +210,8 @@ void VtolType::check_quadchute_condition()
|
||||
// We use tecs for tracking in FW and local_pos_sp during transitions
|
||||
if (_tecs_running) {
|
||||
// 1 second rolling average
|
||||
_ra_hrate = (49 * _ra_hrate + _tecs_status->flight_path_angle) / 50;
|
||||
_ra_hrate_sp = (49 * _ra_hrate_sp + _tecs_status->flight_path_angle_sp) / 50;
|
||||
_ra_hrate = (49 * _ra_hrate + _tecs_status->height_rate) / 50;
|
||||
_ra_hrate_sp = (49 * _ra_hrate_sp + _tecs_status->height_rate_setpoint) / 50;
|
||||
|
||||
// are we dropping while requesting significant ascend?
|
||||
if (((_tecs_status->altitude_sp - _tecs_status->altitude_filtered) > _params->fw_alt_err) &&
|
||||
|
||||
Reference in New Issue
Block a user