mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-10 05:21:35 +08:00
fixed-wing: update rate controller integrator handling
-always reset roll/pitch/yaw integrators at the same time -reset them while waiting for launch or during FW Takeoff before Climbout -reset wheel rate integrator only when disarmed Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
@@ -62,7 +62,7 @@ float ECL_WheelController::control_bodyrate(const float dt, const ECL_ControlDat
|
||||
/* Calculate body angular rate error */
|
||||
const float rate_error = _body_rate_setpoint - ctl_data.body_z_rate; //body angular rate error
|
||||
|
||||
if (!ctl_data.lock_integrator && _k_i > 0.0f && ctl_data.groundspeed > min_speed) {
|
||||
if (_k_i > 0.0f && ctl_data.groundspeed > min_speed) {
|
||||
|
||||
float id = rate_error * dt * ctl_data.groundspeed_scaler;
|
||||
|
||||
|
||||
Reference in New Issue
Block a user