mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-06 07:53:43 +08:00
Typo in AHRS Limiter
This commit is contained in:
@@ -462,8 +462,8 @@ void Drift_correction(void)
|
||||
|
||||
// Here we will place a limit on the integrator so that the integrator cannot ever exceed half the saturation limit of the gyros
|
||||
Integrator_magnitude = sqrt(Vector_Dot_Product(Omega_I,Omega_I));
|
||||
if (Integrator_magnitude > DegOfRad(300)) {
|
||||
Vector_Scale(Omega_I,Omega_I,0.5f*DegOfRad(300)/Integrator_magnitude);
|
||||
if (Integrator_magnitude > RadOfDeg(300)) {
|
||||
Vector_Scale(Omega_I,Omega_I,0.5f*RadOfDeg(300)/Integrator_magnitude);
|
||||
}
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user