Browse Source

AR_AttitudeControl: rate-control for skid-steering uses I term even at low speeds

master
Randy Mackay 7 years ago
parent
commit
ce73d724c8
  1. 4
      libraries/APM_Control/AR_AttitudeControl.cpp

4
libraries/APM_Control/AR_AttitudeControl.cpp

@ -222,9 +222,9 @@ float AR_AttitudeControl::get_steering_out_rate(float desired_rate, bool skid_st @@ -222,9 +222,9 @@ float AR_AttitudeControl::get_steering_out_rate(float desired_rate, bool skid_st
// get p
float p = _steer_rate_pid.get_p();
// get i unless moving at low speed or steering output has hit a limit
// get i unless non-skid-steering rover at low speed or steering output has hit a limit
float i = _steer_rate_pid.get_integrator();
if (!low_speed && ((is_negative(rate_error) && !motor_limit_left) || (is_positive(rate_error) && !motor_limit_right))) {
if ((!low_speed || skid_steering) && ((is_negative(rate_error) && !motor_limit_left) || (is_positive(rate_error) && !motor_limit_right))) {
i = _steer_rate_pid.get_i();
}

Loading…
Cancel
Save