mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-28 16:43: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 */
|
/* Close the acceleration loop if _coordinated_method wants this: change body_rate setpoint */
|
||||||
if (_coordinated_method == COORD_METHOD_CLOSEACC) {
|
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) */
|
/* Transform estimation to body angular rates (jacobian) */
|
||||||
|
|||||||
Reference in New Issue
Block a user