mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-09 12:08:37 +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