Browse Source

APM_Control: allow for smaller minimum tconst

zr-v5.1
Andrew Tridgell 4 years ago
parent
commit
4694820ac3
  1. 4
      libraries/APM_Control/AP_PitchController.cpp
  2. 4
      libraries/APM_Control/AP_RollController.cpp

4
libraries/APM_Control/AP_PitchController.cpp

@ -307,8 +307,8 @@ int32_t AP_PitchController::get_servo_out(int32_t angle_err, float scaler, bool
float rate_offset; float rate_offset;
bool inverted; bool inverted;
if (gains.tau < 0.1f) { if (gains.tau < 0.01f) {
gains.tau.set(0.1f); gains.tau.set(0.01f);
} }
rate_offset = _get_coordination_rate_offset(aspeed, inverted); rate_offset = _get_coordination_rate_offset(aspeed, inverted);

4
libraries/APM_Control/AP_RollController.cpp

@ -221,8 +221,8 @@ int32_t AP_RollController::get_rate_out(float desired_rate, float scaler)
*/ */
int32_t AP_RollController::get_servo_out(int32_t angle_err, float scaler, bool disable_integrator) int32_t AP_RollController::get_servo_out(int32_t angle_err, float scaler, bool disable_integrator)
{ {
if (gains.tau < 0.1f) { if (gains.tau < 0.01f) {
gains.tau.set(0.1f); gains.tau.set(0.01f);
} }
// Calculate the desired roll rate (deg/sec) from the angle error // Calculate the desired roll rate (deg/sec) from the angle error

Loading…
Cancel
Save