Browse Source

AP_SteerController: fix get_steering_out_rate bug when reversing

mission-4.1.18
Randy Mackay 8 years ago
parent
commit
164096225b
  1. 2
      libraries/APM_Control/AP_SteerController.cpp

2
libraries/APM_Control/AP_SteerController.cpp

@ -145,7 +145,7 @@ int32_t AP_SteerController::get_steering_out_rate(float desired_rate) @@ -145,7 +145,7 @@ int32_t AP_SteerController::get_steering_out_rate(float desired_rate)
// We do this in earth frame to allow for rover leaning over in hard corners
float yaw_rate_earth = ToDeg(_ahrs.get_yaw_rate_earth());
if (_reverse) {
yaw_rate_earth = wrap_180(180 + yaw_rate_earth);
yaw_rate_earth *= -1.0f;
}
float rate_error = (desired_rate - yaw_rate_earth) * scaler;

Loading…
Cancel
Save