Kalman Accelerometer Corrector
Corrects Kalman state from accelerometer measurement.
Constructors
Properties
Standard deviation for accelerometer noise expressed in m/s^2.
Contains external acceleration in body coordinates.
Gets expected gravity norm at current location. If no location is available, average gravity at sea level is returned instead.
Accelerometer corrected Kalman error covariance.
Kalman state error covariance after prediction stage.
Corrected Kalman state after processing accelerometer measurement.
Kalman state after prediction.
Contains accelerometer data expressed in NED coordinates respect to body. This is reused for performance reasons.
Contains predicted body attitude for next step. Because rotation is defined respect to body, rotation converts from body coordinates to leveled local NED coordinates respect to Earth: pn = previousBodyQ * pb
Jacobian of predictedNedQ respect to estimated errorQ.