Обновление состояния постоянной скорости
возвращает обновленное состояние, updatedstate = constvel(state)stateмодели движения фильтра Калмана с постоянной скоростью после секундного временного шага.
задает временной шаг, updatedstate = constvel(state,dt) dt.
также указывает состояние шума, updatedstate = constvel(state,w,dt)w.
Для двумерного процесса с постоянной скоростью матрица перехода состояния после временного шага T является блок-диагональной, как показано здесь.
Блок для каждого пространственного размера:
Для каждого дополнительного пространственного размера добавьте идентичный блок.
cameas | cameasjac | constacc | constaccjac | constturn | constturnjac | constveljac | ctmeas | ctmeasjac | cvmeas | cvmeasjac