|
|
|
@ -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; |
|
|
|
|
|
|
|
|
|