# 更新机器人状态的函数 u ; u:卡尔曼滤波中表示控制向量
def updateState(state,u,dt):
"""
:param state [x,y,里程计走的角度,当前最新的速度,当前最新的角速度]:
:param u 控制向量 [当前速度,当前角速度]:
:param dt: 时间间隔,经过dt时间后 推算出x y 角度的值
"""
# xt
# 更新机器人状态的函数 u ; u:卡尔曼滤波中表示控制向量
def updateState(state,u,dt):
"""
:param state [x,y,里程计走的角度,当前最新的速度,当前最新的角速度]:
:param u 控制向量 [当前速度,当前角速度]:
:param dt: 时间间隔,经过dt时间后 推算出x y 角度的值
"""
# xt