mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-06-26 03:10:35 +08:00
add experimantal acceleration feedback by @kd0aij
This commit is contained in:
committed by
Lorenz Meier
parent
e14023e98f
commit
edc5f8a057
@@ -181,7 +181,8 @@ float ECL_YawController::control_bodyrate_impl(const struct ECL_ControlData &ctl
|
||||
|
||||
/* Close the acceleration loop if _coordinated_method wants this: change body_rate setpoint */
|
||||
if (_coordinated_method == COORD_METHOD_CLOSEACC) {
|
||||
//XXX
|
||||
//XXX: filtering of acceleration?
|
||||
_bodyrate_setpoint -= (ctl_data.acc_body_y / (airspeed * cosf(ctl_data.pitch)));
|
||||
}
|
||||
|
||||
/* Transform estimation to body angular rates (jacobian) */
|
||||
|
||||
Reference in New Issue
Block a user