Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: fixed yaw rate tuning in AUTOTUNE mode

Browse Source 
don't reset yaw rate controller continuously while we are trying to
use it
This commit is contained in:
Andrew Tridgell 2022-10-18 18:52:30 +11:00
parent 8847ff8060
commit bffc09eaf5
1 changed files with 9 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
ArduPlane/Attitude.cpp
View File

@ -352,10 +352,6 @@ void Plane::stabilize_yaw(float speed_scaler)
now calculate steering_control.rudder for the rudder
*/
calc_nav_yaw_coordinated(speed_scaler);
/*
When not running the yaw rate controller, we need to reset the rate
*/
yawController.reset_rate_PID();
}
@ -611,6 +607,7 @@ void Plane::calc_nav_yaw_coordinated(float speed_scaler)
int16_t rudder_in = rudder_input();
int16_t commanded_rudder;
bool using_rate_controller = false;
// Received an external msg that guides yaw in the last 3 seconds?
if (control_mode->is_guided_mode() &&
@ -622,6 +619,7 @@ void Plane::calc_nav_yaw_coordinated(float speed_scaler)
const float rudd_expo = rudder_in_expo(true);
const float yaw_rate = (rudd_expo/SERVO_MAX) * g.acro_yaw_rate;
commanded_rudder = yawController.get_rate_out(yaw_rate, speed_scaler, false);
using_rate_controller = true;
} else {
if (control_mode == &mode_stabilize && rudder_in != 0) {
disable_integrator = true;
@ -635,6 +633,13 @@ void Plane::calc_nav_yaw_coordinated(float speed_scaler)
}
steering_control.rudder = constrain_int16(commanded_rudder, -4500, 4500);
if (!using_rate_controller) {
/*
When not running the yaw rate controller, we need to reset the rate
*/
yawController.reset_rate_PID();
}
}
/*