基于多目标优化的无人驾驶车辆运动规划方法

摘要

本发明公开了一种基于多目标优化的无人驾驶车辆运动规划方法，将车辆及环境从笛卡尔坐标系映射到Frenet坐标系；建立无人驾驶车辆多目标路径规划问题的数学模型；利用线性动态规划方法进行路径规划；以分段五次多项式描述轨迹，分别以轨迹斜率最小、曲率最小、乘坐体验舒适、距离线性动态规划得到的路径最近作为优化目标，以分段五次多项式连接点处位置、一阶导、二阶导、三阶导作为等式约束，以道路自然边界约束和障碍物边界约束作为不等式约束，建立无人驾驶车辆多目标轨迹生成问题的数学模型；获得无人驾驶车辆多目标轨迹生成问题的最优解。本发明解决了基于随机撒点的路径规划方法得到的路径难以符合车辆运动学约束的问题。