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