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