initcvpf

Создайте фильтр частиц отслеживания постоянной скорости из отчета о обнаружении

Синтаксис

Описание

пример

pf = initcvpf(detection) инициализирует фильтр частиц с постоянной скоростью для отслеживания объектов на основе информации, представленной в objectDetection объект, detection.

Функция инициализирует состояние постоянной скорости с тем же соглашением, что и constvel и cvmeas, [x; <reservedrangesplaceholder7> <reservedrangesplaceholder6>; y; <reservedrangesplaceholder4> <reservedrangesplaceholder3>; z; <reservedrangesplaceholder1> <reservedrangesplaceholder0>].

Примеры

свернуть все

Создайте объект фильтра частиц отслеживания постоянной скорости, trackingPF, из первоначального отчета об обнаружении. Отчет о обнаружении составляется из начального 3-D измерения положения состояния фильтра частиц в прямоугольных координатах. Можно получить измерение положения 3-D с помощью функции измерения постоянной скорости, cvmeas.

Этот пример использует координаты, x = 1, y = 3, z = 0 и 3-D шум измерения положения [1 0.2 0; 0.2 2 0; 0 0 1].

detection = objectDetection(0, [1;3;0], 'MeasurementNoise', [1 0.2 0; 0.2 2 0; 0 0 1]);

Использование initcvpf для создания trackingPF фильтр, инициализированный в заданном положении и использующий измерительный шум, заданный выше.

pf = initcvpf(detection)
pf = 
  trackingPF with properties:

                       State: [6⨯1 double]
             StateCovariance: [6⨯6 double]
     IsStateVariableCircular: [0 0 0 0 0 0]

          StateTransitionFcn: @constvel
     ProcessNoiseSamplingFcn: []
                ProcessNoise: [3x3 double]
     HasAdditiveProcessNoise: 0

              MeasurementFcn: @cvmeas
    MeasurementLikelihoodFcn: []
            MeasurementNoise: [3x3 double]

                   Particles: [6x1000 double]
                     Weights: [1x1000 double]
            ResamplingPolicy: [1x1 trackingResamplingPolicy]
            ResamplingMethod: 'multinomial'

Проверяйте значения состояния и шума измерения. Проверьте состояние фильтра, pf.State, имеет примерно те же компоненты положения, что и измерение обнаружения, detection.Measurement.

pf.State
ans = 6×1

    0.9674
    0.3690
    3.0471
    0.2733
    0.0306
   -0.5904

Проверьте, что шум измерения фильтра, pf.MeasurementNoise, совпадает с detection.MeasurementNoise значения.

pf.MeasurementNoise
ans = 3×3

    1.0000    0.2000         0
    0.2000    2.0000         0
         0         0    1.0000

Создайте объект фильтра частиц отслеживания постоянной скорости, trackingPF, из первоначального отчета об обнаружении. Отчет о обнаружении составляется из начального 3-D измерения положения состояния фильтра частиц в сферических координатах. Можно получить измерение положения 3-D с помощью функции измерения постоянной скорости, cvmeas.

Этот пример использует координаты az = 30, e1 = 5, r = 100, rr = 4 и измерение шум diag([2.5, 2.5, 0.5, 1].^2).

meas = [30;5;100;4];
measNoise = diag([2.5, 2.5, 0.5, 1].^2);

Используйте MeasurementParameters свойство detection объект для определения системы координат. Когда не определено, поля MeasurementParameters struct использует значения по умолчанию. В этом примере положение датчика, скорость датчика, ориентация, повышение и скорость области значений по умолчанию.

measParams = struct('Frame','spherical');
detection = objectDetection(0,meas,'MeasurementNoise',measNoise,...
    'MeasurementParameters',measParams) 
detection = 
  objectDetection with properties:

                     Time: 0
              Measurement: [4x1 double]
         MeasurementNoise: [4x4 double]
              SensorIndex: 1
            ObjectClassID: 0
    MeasurementParameters: [1x1 struct]
         ObjectAttributes: {}

Использование initcvpf для создания trackingPF фильтр, инициализированный в заданном положении и использующий измерительный шум, заданный выше.

pf = initcvpf(detection)
pf = 
  trackingPF with properties:

                       State: [6⨯1 double]
             StateCovariance: [6⨯6 double]
     IsStateVariableCircular: [0 0 0 0 0 0]

          StateTransitionFcn: @constvel
     ProcessNoiseSamplingFcn: []
                ProcessNoise: [3x3 double]
     HasAdditiveProcessNoise: 0

              MeasurementFcn: @cvmeas
    MeasurementLikelihoodFcn: []
            MeasurementNoise: [4x4 double]

                   Particles: [6x1000 double]
                     Weights: [1x1000 double]
            ResamplingPolicy: [1x1 trackingResamplingPolicy]
            ResamplingMethod: 'multinomial'

Проверьте, что состояние фильтра создает примерно то же измерение, что и detection.Measurement.

meas2 = cvmeas(pf.State, detection.MeasurementParameters)
meas2 = 4×1

   29.9188
    5.0976
   99.8303
    4.0255

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

свернуть все

Отчет об обнаружении, заданный как objectDetection объект.

Пример: detection = objectDetection(0,[1;4.5;3],'MeasurementNoise', [1.0 0 0; 0 2.0 0; 0 0 1.5])

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

свернуть все

Фильтр частиц с постоянной скоростью для отслеживания объектов, возвращенный как trackingPF объект.

Алгоритмы

  • Функция конфигурирует фильтр с 1000 частицами. При создании фильтра функция вычисляет матрицу шума процесса, принимая модуль стандартное отклонение ускорения.

  • Вы можете использовать эту функцию как FilterInitializationFcn свойство trackerTOMHT и trackerGNN Системные объекты.

Расширенные возможности

Генерация кода C/C + +
Сгенерируйте код C и C++ с помощью Coder™ MATLAB ®

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