KalmanAccelerometerCorrector

class KalmanAccelerometerCorrector(val externalAccelerationCovarianceMatrixEstimationMethod: ExternalAccelerationCovarianceMatrixEstimationMethod = DEFAULT_EXTERNAL_ACCELERATION_COVARIANCE_MATRIX_ESTIMATION_METHOD)

Corrects Kalman state from accelerometer measurement.

Constructors

Link copied to clipboard
constructor(externalAccelerationCovarianceMatrixEstimationMethod: ExternalAccelerationCovarianceMatrixEstimationMethod = DEFAULT_EXTERNAL_ACCELERATION_COVARIANCE_MATRIX_ESTIMATION_METHOD)

Types

Link copied to clipboard
object Companion

Properties

Link copied to clipboard

Standard deviation for accelerometer noise expressed in m/s^2.

Link copied to clipboard
val ba: Matrix

Contains accelerometer bias expressed in meters per squared second (m/s^2).

Link copied to clipboard
val bg: Matrix

Contains gyroscope bias expressed in radians per second (rad/s).

Link copied to clipboard
val bodyQ: Quaternion

Contains corrected body attitude.

Link copied to clipboard
val externalAcceleration: AccelerationTriad

Contains external acceleration in body coordinates.

Link copied to clipboard

Gets expected gravity norm at current location. If no location is available, average gravity at sea level is returned instead.

Link copied to clipboard

Accelerometer corrected Kalman error covariance.

Link copied to clipboard

Kalman state error covariance after prediction stage.

Link copied to clipboard

Corrected Kalman state after processing accelerometer measurement.

Link copied to clipboard

Kalman state after prediction.

Link copied to clipboard
var nedBodyAccelerationTriad: AccelerationTriad

Contains accelerometer data expressed in NED coordinates respect to body. This is reused for performance reasons.

Link copied to clipboard
var predictedBodyQ: Quaternion

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

Link copied to clipboard

Jacobian of predictedNedQ respect to estimated errorQ.

Functions

Link copied to clipboard
fun correct()

Computes accelerometer measurement correction.

Link copied to clipboard
fun reset()

Resets this corrector instance to its initial state.