本发明涉及用于自动化停车的方法和系统,该方法和系统使用车辆的几何结构和停车空间的地图确定通过路点集合连接车辆的初始状态与停放车辆的目标状态的无碰撞几何路径;并且使用车辆的运动学模型确定形成运动学图的运动学子图集合,该运动学图具有用运动学边连接的多个节点。
各路点限定车辆的位置和方位,各运动学子图将几何路径的一对相邻路点连接,各节点限定车辆的状态,并且连接两个节点的各运动学边根据车辆的运动学特性限定连接两个节点的无碰撞运动学路径。
从运动学图选择运动学路径,并且使用车辆的动态模型确定作为时间的函数对运动学路径进行跟踪的参考轨迹。
车辆的运动根据参考轨迹。
王烨宾 D·贾
三菱电机株式会社
日本东京都
本发明涉及用于自动化停车的方法和系统,该方法和系统使用车辆的几何结构和停车空间的地图确定通过路点集合连接车辆的初始状态与停放车辆的目标状态的无碰撞几何路径;并且使用车辆的运动学模型确定形成运动学图的运动学子图集合,该运动学图具有用运动学边连接的多个节点。
各路点限定车辆的位置和方位,各运动学子图将几何路径的一对相邻路点连接,各节点限定车辆的状态,并且连接两个节点的各运动学边根据车辆的运动学特性限定连接两个节点的无碰撞运动学路径。
从运动学图选择运动学路径,并且使用车辆的动态模型确定作为时间的函数对运动学路径进行跟踪的参考轨迹。
车辆的运动根据参考轨迹。