从几何的角度:
两个坐标系:地图坐标系、机器人坐标系
规划出的路线也需要表示在地图坐标系下
导航规划需要考虑的约束:
最大速度
最大加速度
非完整性约束
最小转弯半径
非完整性约束:
标准轮存在两个约束:
世界坐标系下的质心速度和机器人坐标系下的质心速度之间转换:
只要$R(\theta)$不是常量,那么机器人就能转向
在机器人坐标系下描述轮子: