恒转率运动模型
返回更新后的状态,updatedstate
= constturn (状态
)updatedstate
,从以前的状态获得,状态
,在一秒的步长时间后,运动模型为恒定的转弯率。恒定的旋转速度意味着在x-y平面遵循恒定的角速度和垂直运动z方向遵循恒定速度模型。
还指定了时间步长,updatedstate
= constturn (状态
,dt
)dt
.
还指定了噪音,updatedstate
= constturn (状态
,w
,dt
)w
.
constacc
|constaccjac
|cameas
|cameasjac
|constturnjac
|ctmeas
|ctmeasjac
|constvel
|constveljac
|cvmeas
|cvmeasjac
|initctekf
|initctukf