Документация

measurementjac = ctmeasjac(state) возвращает якобиан измерения, measurementjac, для постоянной модели движения Фильтра Калмана угловой скорости вращения в прямоугольных координатах. state задает текущее состояние дорожки.

measurementjac = ctmeasjac(state,frame) также задает систему координат измерения, frame.

measurementjac = ctmeasjac(state,frame,sensorpos) также задает положение датчика, sensorpos.

measurementjac = ctmeasjac(state,frame,sensorpos,sensorvel) также задает скорость датчика, sensorvel.

measurementjac = ctmeasjac(state,frame,sensorpos,sensorvel,laxes) также задает локальную ориентацию осей датчика, laxes.

measurementjac = ctmeasjac(state,measurementParameters) задает параметры измерения, measurementParameters.

Примеры

Якобиан измерения постоянного движения угловой скорости вращения в прямоугольной системе координат

Задайте состояние объекта в 2D постоянном движении угловой скорости вращения. Состояние является положением и скоростью в каждой размерности и угловой скоростью вращения. Создайте якобиан измерения в прямоугольных координатах.

state = [1;10;2;20;5];
jacobian = ctmeasjac(state)

jacobian = 3×5

     1     0     0     0     0
     0     0     1     0     0
     0     0     0     0     0

Якобиан измерения постоянного движения угловой скорости вращения в сферической системе координат

Задайте состояние объекта в 2D постоянном движении угловой скорости вращения. Состояние является положением и скоростью в каждой размерности и угловой скоростью вращения. Вычислите якобиан измерения относительно сферических координат.

state = [1;10;2;20;5];
measurementjac = ctmeasjac(state,'spherical')

measurementjac = 4×5

  -22.9183         0   11.4592         0         0
         0         0         0         0         0
    0.4472         0    0.8944         0         0
    0.0000    0.4472    0.0000    0.8944         0

Якобиан измерения постоянного объекта угловой скорости вращения в переведенной сферической системе координат

state = [1;10;2;20;5];
sensorpos = [5;-20;0];
measurementjac = ctmeasjac(state,'spherical',sensorpos)

measurementjac = 4×5

   -2.5210         0   -0.4584         0         0
         0         0         0         0         0
   -0.1789         0    0.9839         0         0
    0.5903   -0.1789    0.1073    0.9839         0

Якобиан измерения постоянного объекта угловой скорости вращения Используя параметры измерения

state2d = [1;10;2;20;5];
sensorpos = [25,-40,0].';
frame = 'spherical';
sensorvel = [0;5;0];
laxes = eye(3);
measurementjac = ctmeasjac(state2d,frame,sensorpos,sensorvel,laxes)

measurementjac = 4×5

   -1.0284         0   -0.5876         0         0
         0         0         0         0         0
   -0.4961         0    0.8682         0         0
    0.2894   -0.4961    0.1654    0.8682         0

Поместите параметры измерения в структуру и используйте альтернативный синтаксис.

measparm = struct('Frame',frame,'OriginPosition',sensorpos,'OriginVelocity',sensorvel, ...
    'Orientation',laxes);
measurementjac = ctmeasjac(state2d,measparm)

measurementjac = 4×5

   -1.0284         0   -0.5876         0         0
         0         0         0         0         0
   -0.4961         0    0.8682         0         0
    0.2894   -0.4961    0.1654    0.8682         0

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

`state` — Вектор состояния
вектор с 5 элементами с действительным знаком | вектор с 7 элементами с действительным знаком | 5 N матрицей с действительным знаком | 7 N матрицей с действительным знаком

Вектор состояния для постоянной модели движения угловой скорости вращения в двух или трех пространственных размерностях в виде вектора с действительным знаком или матрицы.

Когда задано как вектор с 5 элементами, вектор состояния описывает 2D движение в плоскости x-y. Можно задать вектор состояния как строку или вектор-столбец. Компонентами вектора состояния является [x;vx;y;vy;omega] где x представляет x - координата и vx представляет скорость в x - направление. y представляет y - координата и vy представляет скорость в y - направление. omega представляет угловую скорость вращения.
Когда задано как 5 N матрицей, каждый столбец представляет различный вектор состояния, N представляет количество состояний.
Когда задано как вектор с 7 элементами, вектор состояния описывает 3-D движение. Можно задать вектор состояния как строку или вектор-столбец. Компонентами вектора состояния является [x;vx;y;vy;omega;z;vz] где x представляет x - координата и vx представляет скорость в x - направление. y представляет y - координата и vy представляет скорость в y - направление. omega представляет угловую скорость вращения. z представляет z - координата и vz представляет скорость в z - направление.
Когда задано как 7 N матрицей, каждый столбец представляет различный вектор состояния. N представляет количество состояний.

Координаты положения исчисляются в метрах. Скоростные координаты находятся в метрах/секунда. Угловая скорость вращения находится в степенях/секунда.

Пример: [5;0.1;4;-0.2;0.01]

Типы данных: double

`frame` — Measurement система координат выхода
`'rectangular'` (значение по умолчанию) | `'spherical'`

Measurement система координат выхода в виде 'rectangular' или 'spherical'. Когда системой координат является 'rectangular', измерение состоит из x, y и Декартовых координат z. Когда задано как 'spherical', измерение состоит из азимута, вертикального изменения, области значений и уровня области значений.

Типы данных: char

`sensorpos` — Положение датчика
[0;0;0] (значение по умолчанию) | вектор-столбец 3 на 1 с действительным знаком

Положение датчика относительно навигации структурирует в виде вектор-столбца 3 на 1 с действительным знаком. Модули исчисляются в метрах.

Типы данных: double

`sensorvel` — Скорость датчика
[0;0;0] (значение по умолчанию) | вектор-столбец 3 на 1 с действительным знаком

Скорость датчика относительно навигации структурирует в виде вектор-столбца 3 на 1 с действительным знаком. Модули находятся в m/s.

Типы данных: double

`laxes` — Локальные оси координат датчика
[1,0,0;0,1,0;0,0,1] (значение по умолчанию) | 3х3 ортогональная матрица

Локальные оси координат датчика в виде 3х3 ортогональной матрицы. Каждый столбец задает направление локального x - y - и z - оси, соответственно, относительно системы координат навигации. Таким образом, матрица является матрицей вращения от глобальной системы координат до системы координат датчика.

Типы данных: double

`measurementParameters` — Параметры измерения
структура | массив структуры

Параметры измерения в виде структуры или массива структур. Поля структуры:

Поле	Описание	Пример
`Frame`	Система координат раньше сообщала об измерениях в виде одного из этих значений: `'rectangular'` — Об обнаружениях сообщают в прямоугольных координатах. `'spherical'` — Об обнаружениях сообщают в сферических координатах.	`'spherical'`
`OriginPosition`	Смещение положения источника системы координат относительно родительской системы координат в виде `[x y z]` вектор с действительным знаком.	[0 0 0]
`OriginVelocity`	Скоростное смещение источника системы координат относительно родительской системы координат в виде `[vx vy vz]` вектор с действительным знаком.	[0 0 0]
`Orientation`	Структурируйте матрицу вращения в виде 3х3 ортонормированной матрицы с действительным знаком.	[1 0 0; 0 1 0; 0 0 1]
`HasAzimuth`	Логический скаляр, указывающий, включен ли азимут в измерение.	1
`HasElevation`	Логический скаляр, указывающий, включено ли вертикальное изменение в измерение. Для измерений, о которых сообщают в прямоугольной системе координат, и если `HasElevation` является ложным, измерения, о которых сообщают, принимают 0 градусов вертикального изменения.	1
`HasRange`	Логический скаляр, указывающий, включена ли область значений в измерение.	1
`HasVelocity`	Логический скаляр, указывающий, включают ли обнаружения, о которых сообщают, скоростные измерения. Для измерений, о которых сообщают в прямоугольной системе координат, если `HasVelocity` является ложным, об измерениях сообщают как `[x y z]`. Если `HasVelocity` `true`, об измерениях сообщают как `[x y z vx vy vz]`.	1
`IsParentToChild`	Логический скаляр, указывающий, если `Orientation` выполняет вращение системы координат от системы координат координаты вышестоящего элемента до системы координат координаты нижестоящего элемента. Когда `IsParentToChild` `false`, затем `Orientation` выполняет вращение системы координат от системы координат координаты нижестоящего элемента до системы координат координаты вышестоящего элемента.	0

Если вы только хотите выполнить одно координатное преобразование, такое как преобразование от системы координат тела до системы координат датчика, только необходимо задать структуру параметра измерения. Если вы хотите выполнить несколько координатных преобразований, необходимо задать массив структур параметра измерения. Чтобы изучить, как выполнить несколько преобразований, смотрите Обнаружения Преобразования к objectDetection Формату (Sensor Fusion and Tracking Toolbox) пример.

Типы данных: struct

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

`measurementjac` — Якобиан измерения
матрица 3 на 5 с действительным знаком | с действительным знаком 4 5 матрица

Якобиан измерения, возвращенный как 3 на 5 с действительным знаком или 4 5 матрица. Размерность строки и интерпретация зависят от значения frame аргумент.

Система координат Якобиан измерения

'rectangular' Якобиан измерений [x;y;z] относительно вектора состояния. Вектор измерения относительно системы локальной координаты. Координаты исчисляются в метрах.

'spherical' Якобиан вектора измерения [az;el;r;rr] относительно вектора состояния. Компоненты вектора измерения задают угол азимута, угол возвышения, область значений и уровень области значений объекта относительно локальной системы координат датчика. Угловые модули в градусах. Модули области значений исчисляются в метрах и располагаются, модули уровня находятся в метрах/секунда.

Система координат	Якобиан измерения
`'rectangular'`	Якобиан измерений `[x;y;z]` относительно вектора состояния. Вектор измерения относительно системы локальной координаты. Координаты исчисляются в метрах.
`'spherical'`	Якобиан вектора измерения `[az;el;r;rr]` относительно вектора состояния. Компоненты вектора измерения задают угол азимута, угол возвышения, область значений и уровень области значений объекта относительно локальной системы координат датчика. Угловые модули в градусах. Модули области значений исчисляются в метрах и располагаются, модули уровня находятся в метрах/секунда.

Больше о