一种面向四轮转向车辆的狭窄空间泊车运动规划方法

本发明涉及一种面向四轮转向车辆的狭窄空间泊车运动规划方法，包括：构建车辆的四轮转向运动学模型；基于四轮转向运动学模型，进行Hybrid A*算法的节点扩展过程，用于搜索起点到终点的带有四轮转向特性的粗轨迹；将泊车构建为非线性优化问题，使用OBCA算法，并以粗轨迹作为初始解进行数值求解，得到泊车运动轨迹；根据泊车运动轨迹，相应控制车辆完成泊车。与现有技术相比，本发明一方面根据四轮转向运动学改进Hybrid A*算法，另一方面将四轮转向运动学应用于泊车的非线性优化，并使用OBCA算法进行精准地避障约束，能够充分利用四轮转向车辆的灵活机动能力进行狭窄空间的泊车规划，有效提高泊车效率，并且效率随最大后轮转角的增加而提高。