Main Content


Residuals and residual covariances from direct state measurements for insfilterNonholonomic


[res, resCov]= residual(FUSE,idx,measurement,measurementCovariance) computes the residual, res, and the residual covariance, resCov, based on the direct state measurement and measurement covariance. The measurement maps directly to the states specified by indices, idx.

Input Arguments

collapse all

insfilterNonholonomic, specified as an object.

State vector index of measurement to correct, specified as an N-element vector of increasing integers in the range [1,16].

The state values represent:

Orientation (quaternion parts) 1:4
Gyroscope bias (XYZ)rad/s5:7
Position (NED)m8:10
Velocity (NED)m/s11:13
Accelerometer Bias (XYZ)m/s214:16

Data Types: single | double

Direct measurement of state, specified as a N-element vector. N is the number of elements of the index argument, idx.

Covariance of measurement, specified as an N-by-N matrix. N is the number of elements of the index argument, idx.

Output Arguments

collapse all

Measurement residual, returned as a 1-by-N vector of real values.

Residual covariance, returned as a N-by-N matrix of real values.

Extended Capabilities

C/C++ Code Generation
Generate C and C++ code using MATLAB® Coder™.

Introduced in R2020a