Создайте постоянное ускорение, отслеживающее объект Фильтра Калмана кубатуры, trackingCKF, из первоначального отчета обнаружения. Отчет обнаружения сделан из начального 3-D измерения положения состояния Фильтра Калмана в прямоугольных координатах. Можно получить 3-D измерение положения с помощью постоянной ускоряющей функции измерения, cameas.
Этот пример использует координаты, x = 1, y = 3, z = 0 и 3-D шум измерения положения [1 0.2 0; 0.2 2 0; 0 0 1].
Используйте initcackf, чтобы создать фильтр trackingCKF, инициализированный в обеспеченном положении и использовании шума измерения, заданного выше.
ckf =
trackingCKF with properties:
State: [9x1 double]
StateCovariance: [9x9 double]
StateTransitionFcn: @constacc
ProcessNoise: [3x3 double]
HasAdditiveProcessNoise: 0
MeasurementFcn: @cameas
MeasurementNoise: [3x3 double]
HasAdditiveMeasurementNoise: 1
Проверяйте значения состояния и шума измерения. Проверьте, что состояние фильтра, ckf.State, имеет те же компоненты положения как измерение обнаружения, detection.Measurement.
ans = 9×1
1
0
0
3
0
0
0
0
0
Проверьте, что шум измерения фильтра, ckf.MeasurementNoise, совпадает со значениями detection.MeasurementNoise.
ans = 3×3
1.0000 0.2000 0
0.2000 2.0000 0
0 0 1.0000
Copyright 2018 The MathWorks, Inc.