fix ahrs rates when copying to fw estimator

This commit is contained in:
Felix Ruess
2011-08-23 17:33:13 +02:00
parent d6d0024967
commit cce5d4d9ff
+1 -1
View File
@@ -345,7 +345,7 @@ void ahrs_update_fw_estimator(void)
estimator_psi = att.psi; estimator_psi = att.psi;
struct FloatRates rates; struct FloatRates rates;
RATES_FLOAT_OF_BFP(rates, ahrs_float.body_rate); RATES_FLOAT_OF_BFP(rates, ahrs.body_rate);
estimator_p = rates.p; estimator_p = rates.p;
estimator_q = rates.q; estimator_q = rates.q;