AP_Mount: Change misnomer (NFC)
This commit is contained in:
parent
6e6e807223
commit
e041b647d7
@ -886,7 +886,7 @@ float SoloGimbalEKF::calcMagHeadingInnov()
|
|||||||
// Define rotation from magnetometer to NED axes
|
// Define rotation from magnetometer to NED axes
|
||||||
Matrix3f Tmn = Tsn*Tms;
|
Matrix3f Tmn = Tsn*Tms;
|
||||||
|
|
||||||
// rotate magentic field measured at top plate into NED axes afer applying bias values learnt by main EKF
|
// rotate magnetic field measured at top plate into NED axes afer applying bias values learnt by main EKF
|
||||||
Vector3f magMeasNED = Tmn*(magData - body_magfield);
|
Vector3f magMeasNED = Tmn*(magData - body_magfield);
|
||||||
|
|
||||||
// calculate the innovation where the predicted measurement is the angle wrt magnetic north of the horizontal component of the measured field
|
// calculate the innovation where the predicted measurement is the angle wrt magnetic north of the horizontal component of the measured field
|
||||||
|
Loading…
Reference in New Issue
Block a user