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

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

A normal speed planning strategy based on road curvature

【技术实现步骤摘要】
一种基于道路曲率的常规行驶车速规划策略
本专利技术属于自动驾驶车辆速度规划领域，尤其是涉及一种基于道路曲率的常规行驶车速规划策略。
技术介绍
自动驾驶技术被视为交通安全事故、交通拥堵等问题的最终解决方案，自诞生以来一直备受各国政府、高等院校以及相关机构重视。环境感知、决策规划与运动控制被视为自动驾驶技术的三大核心问题。其中，决策规划系统负责根据环境感知系统获取的交通环境信息确定目标路径以及目标车速，而后传递给运动控制系统进行执行。对目标车速的规划是整个决策规划系统的基础也是重要组成部分，然而现有对自动驾驶目标车速的规划主要面向自适应巡航、紧急避撞或者某一类特定交通场景，或者以车辆的燃油经济性为前提进行规划，也有一些面向常规行驶工况(即前方无障碍物的一般工况)的车速规划研究，但却需要多个环境参数，对传感器要求较多，算法也相对复杂，导致系统实时性较差。
技术实现思路
有鉴于此，本专利技术旨在提出一种基于道路曲率的常规行驶车速规划策略，以解决上述
技术介绍
中提到的问题。为达到上述目的，本专利技术的技术方案是这样实现的：...

【技术保护点】
1.一种基于道路曲率的常规行驶车速规划策略，其特征在于：包括以下步骤：/n步骤S1：通过本车环境感知系统和路径规划系统获取车辆前方一段弧长为L的目标路径上所有目标点的坐标信息{(x

【技术特征摘要】
1.一种基于道路曲率的常规行驶车速规划策略，其特征在于：包括以下步骤：
步骤S1：通过本车环境感知系统和路径规划系统获取车辆前方一段弧长为L的目标路径上所有目标点的坐标信息{(x1,y1)，(x2,y2)，……}以及车辆自身位置信(Xv,Yv)；
步骤S2：根据已知目标路径上所有目标点的坐标信息{(x1,y1)，(x2,y2)，……}和本车位置信息(Xv,Yv)，计算距离本身位置最近的最近点(xn,yn)；
步骤S3：根据预瞄距离ld确定预瞄点(xp,yp)，进而计算汽车当前位置(Xv,Yv)与预瞄点连线的直线方程f(x')；
步骤S4：遍历最近点与预瞄点之间的所有目标点，计算这些点与步骤S3中直线f(x')的距离di,(i＝1,2,…)，进而确定最大距离点(xm,ym)；
步骤S5：计算最大距离点(xm,ym)处的曲率半径R，根据R计算此点目标车速，当前采用计算公式为：
Vdes＝a/(1+e-b*(R-c))(1)
其中，a,b,c为调节参数，a车速变化范围，b决定车速随曲率的变化率，c决定最低车速；
步骤S6：计算最大距离点(xm,ym)与当前车辆位置(Xv,Yv)间的距离s，根据公式ades＝(Vt2-Vdes2)/(2*s)计算实现以当前车速Vt减速到最大距离点期望车速Vdes的期望减速度；
步骤S7：比较步骤S6中减速度ades与设定的舒适减速度ac，若ades≥ac，则保持当前车速；若ades＜ac，则以ades进行减速。


2.根据权利要求1所述的一种基于道路曲率的常规行驶车速规划策略，其特征在于：所述步骤S3中，预瞄点(xp,yp)的确定方式如下：
1)根据如下公式确定预瞄距离：



式中，ld_...

【专利技术属性】
技术研发人员：高琳琳，龚进峰，戎辉，唐风敏，郭蓬，何佳，吴学易，夏海鹏，
申请(专利权)人：中汽研天津汽车工程研究院有限公司，中国汽车技术研究中心有限公司，
类型：发明
国别省市：天津;12