mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-05 23:49:00 +08:00
fix ahrs rates when copying to fw estimator
This commit is contained in:
@@ -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;
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user