residual

Невязки и остаточные ковариации от прямых измерений состояния для insfilterMARG

Описание

[res, resCov]= residual(FUSE,idx,measurement,measurementCovariance) вычисляет невязку, res, и остаточная ковариация, resCov, основанный на прямом измерении состояния и ковариации измерения. The measurement сопоставляется непосредственно с состояниями, заданными индексами, idx.

Входные параметры

свернуть все

insfilterMARG, заданный как объект.

Векторный индекс состояния измерения, заданный как N-элементный вектор увеличивающихся целых чисел в области значений [1, 22].

Значения состояния представляют:

ГосударствоМодулиИндекс
Ориентация (кватернионные части) 1:4
Положение (NED)m5:7
Скорость (NED)м/с8:10
Смещение угла дельты (XYZ)рад11:13
Смещение скорости в дельте (XYZ)м/с14:16
Геомагнитные Вектора поля (NED)µT17:19
Смещение магнитометра (XYZ)µT20:22

Прямое измерение состояния, заданное как N-вектор. N - количество элементов индекса, idx.

Ковариация измерения, заданная как N -by - N матрица. N - количество элементов индекса, idx.

Выходные аргументы

свернуть все

Остаток от измерения, возвращенный как 1-байт- N вектор вещественных значений.

Остаточная ковариация, возвращенная как N -by - N матрица вещественных значений.

См. также

Введенный в R2020a