EKF_AW Initialization fix (#3364)

This commit is contained in:
Christophe De Wagter
2024-09-25 09:54:32 +02:00
committed by GitHub
parent b400d1b995
commit 3794ffceeb
+1 -1
View File
@@ -694,7 +694,7 @@ void ekf_aw_propagate(struct FloatVect3 *acc, struct FloatRates *gyro, struct Fl
// Calculate Angle of Attack
float aoa = atan2f(w, fabsf(u) < 1.E-5 ? 1E-5 : u); // Protected alpha calculation
float sat_aoa;
float sat_aoa = 0;
Bound(sat_aoa, deg2rad * EKF_AW_AOA_MIN_ANGLE, deg2rad * EKF_AW_AOA_MAX_ANGLE); // Saturate alpha
float tan_aoa = tanf(aoa);