一种基于道路曲率的常规行驶车速规划策略

摘要

本发明提供了一种基于道路曲率的常规行驶车速规划策略，包括以下步骤：通过本车环境感知系统和路径规划系统获取车辆前方一段弧长为L的目标路径上所有目标点的坐标信息及车辆自身位置信息；根据上述信息计算距离本身位置最近的最近点；根据预瞄距离确定预瞄点，进而计算汽车当前位置与预瞄点连线的直线方程；遍历最近点与预瞄点之间的所有目标点，计算这些点与上述直线的距离，进而确定最大距离点；计算最大距离点处的曲率半径，根据曲率半径计算此点目标车速，计算最大距离点与当前车辆位置间的距离，计算实现以当前车速减速到最大距离点期望车速的期望减速度；比较减速度与设定的舒适减速度，确定保持当前车速还是进行减速。