一种基于结构化道路采样的主动换道规划方法技术

本发明专利技术公开了一种一种基于结构化道路采样的主动换道规划方法，包括以下步骤：步骤S1：对换道场景的道路进行空间采样处理；步骤S2：对采样点进行横纵向多项式换道轨迹生成求解；步骤S3：对计算出的若干轨迹进行评价函数计算，筛选最优轨迹。本发明专利技术构建了车辆运动学模型，并在车辆运动学模型的约束下，生成换道轨迹，很好的解决了传统方法的换道轨迹不符合车辆运动状态的问题；通过对结构化道路的状态空间采样，生成多组变道轨迹，并引入评价函数，求出最优换道轨迹。出最优换道轨迹。出最优换道轨迹。

【技术实现步骤摘要】
一种基于结构化道路采样的主动换道规划方法


[0001]本专利技术涉及一种换道规划方法，尤其是涉及一种基于结构化道路采样的主动换道规划方法。

技术介绍

[0002]本专利技术对结构化道路进行状态空间采样处理，通过车辆运动学约束，对采样点进行多项式曲线生成，加入评价函数，对生成的多组换道轨迹进行打分计算，通过不同的权重设定，最终筛选出一组最优变道轨迹，可指导辅助驾驶车辆进行安全无碰撞的变道行驶，并提高了乘车的舒适性。
[0003]现有的主动换道规划方法是根据当前车辆位置点和换道到达位置点进行多段几何曲线生成，并根据雷达识别到的障碍物信息和生成的几何曲线进行碰撞检测，无碰撞风险时，车辆可按曲线换道行驶。
[0004]现有技术具有以下缺点：现有技术主动换道的规划轨迹是根据传统几何方法推算出的，没有考虑车辆运动学的约束，因此现有技术中主动换道的规划轨迹不是最符合车辆行驶的。
[0005]现有技术主动换道的规划轨迹没有综合考虑碰撞风险、行车舒适性和轨迹平滑性等因素，因此现有技术主动换道的规划轨迹不是最优的。
[0006]例如，一种在中国专利文献上公开的“一种汽车换道避撞控制方法”，其公告号 CN105857294B，包括没有综合考虑碰撞风险、行车舒适性和轨迹平滑性等因素，无法达到最优轨迹规划的问题。

技术实现思路

[0007]本专利技术是为了克服现有技术中没有综合考虑考虑碰撞风险、行车舒适性和平滑轨迹性等因素，无法达到最优主动换道的问题，提出一种基于结构化道路采样的主动换道规划方法。
[0008]为了实现上述目的，本专利技术采用以下技术方案：一种基于结构化道路采样的主动换道规划方法，其特征是，包括以下步骤：步骤S1：对换道场景的道路进行空间采样处理；步骤S2：对采样点进行横纵向多项式换道轨迹生成求解；步骤S3：对计算出的若干轨迹进行评价函数计算，筛选最优轨迹。
[0009]本专利技术构建了车辆运动学模型，并在车辆运动学模型的约束下，生成换道轨迹，很好的解决了传统方法的换道轨迹不符合车辆运动状态的问题。
[0010]作为优选，步骤S1包括以下步骤：步骤S11：对相邻车道线的5次多项式系数进行求和取均值，得到中间车道线的多项式方程；步骤S12：根据得到的参考线，按固定间隔，均匀布置采样点；对采样点进行横纵向多项式轨迹生成求解，并对计算出的若干轨迹进行评价函数计算，筛选出最优轨迹，解决了传统技术方案生成的轨迹单一，不是最优解的问题。
[0011]作为优选，中间车道的多项式方程的内容：其中，leftcoeffs为左道线系数，rightcoeffs为右道线系数，通过对中间车道线的计算，较为精确地获取复杂路况的轨迹数据，并对计算出的若干轨迹进行评价函数计算，生成大量方案数据进行比对，获取道路主动换道的最优解。
[0012]作为优选，步骤S12包括以下内容：采样点的纵向距离间隔为 max[4s*Vc
urrentSpeed
,Vs
toppingDistance
]/5，其中，Vc
urrentSpeed
为当前车速，4s*Vc
urrentSpeed
即为当前车速下在4s内的行车距离；Vs
toppingDistance
为当前时速的最大制动距离；采样点横向距离间隔为 (load_width
‑
vehicle_width)/2；其中load_width为相邻车道的路宽，vehicle_width为车宽，针对不同的实际车况路况获取不同的运动轨迹曲线，使得主动换道的规划轨迹更符合车辆的实时行驶状况。
[0013]作为优选，步骤S2包括以下步骤：步骤S21：根据上述步骤得到的采样点，构建车辆运动学模型；步骤S22：根据采样的轨迹点，采用多项式螺旋线来连接轨迹点，生成轨迹曲线；换道轨迹生成主要用于实现辅助驾驶车辆的主动换道功能，根据上节得到的采样点，对不同采样点分别求解在车辆运动模型约束下的多项式曲线方程，使获得的曲线更接近最优路线。
[0014]作为优选，车辆运动学模型的内容为：设定车辆姿态向量X＝(x,y,θ,k,v)，其中x,y 是二维平面位置，θ是车辆朝向，k表示曲率，v是车辆线速度，其标量大小满足以下关系：为后续计算提供数据支持，保证路线规划数据的准确性和实时性。
[0015]作为优选，将轨迹曲线定义为三次多项式螺旋，轨迹的曲率k是弧长s的三次多项式函数，代入参数向量p＝[p
0 p
1 p
2 p
3 s
f
]，其中，s
f
是边界约束之间的曲线的弧长，参数代入实际数据，保证数据准确性，使得主动换道的规划轨迹更符合车辆的实时行驶状况。
[0016]作为优选，评价函数是多种评价函数项的线性组合，将步骤S2中的轨迹离散为n+1 个点，评价函数包括以下内容：偏离车道cost函数f
offset
:其中，ΔS为离散点与相应在参考线上的映射点的偏差平方；平滑性cos函数f
smooth
:其中，k为曲率；舒适性cost函数f
jeck
:其中，J为加加速度；碰撞cost函数f
collision
：f
collision
＝1/min(||P
i
‑
P
obs
||)，(i∈0～n)，其中，P
obs
为障碍物的坐标向量，P为离散轨迹的坐标向量；向心加速度cost函数f
collision
：f
collision
＝1/min(||P
i
‑
P
obs
||)，(i∈0～n)，其中，P
obs
为障碍物的坐标向量，P为离散轨迹的坐标向量；
合成cost：f＝w
offset
*f
offset
+w
smooth
*f
smooth
+w
jeck
*f
jeck
+w
collision
*f
collision
+w
centripetal
*f
centripetal
，其中，w
offset
、w
smooth
、w
jeck
、w
collision
、w
centripetal
是各函数自调节的权重系数，根据可调节的权重系数设计，最终完成对轨迹的cost函数计算处理；对计算得出的数据做综合处理，使得最终获得的换道轨迹能综合考虑到碰撞风险、行车舒适性和轨迹平滑性等因素，使得系统规划的换道接近最优解。
[0017]因此，本专利技术具有以下有益效果：构建了车辆运动学模型，并在车辆运动学模型的约束下，生成换道轨迹，很好的解决了传统方法的换道轨本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于结构化道路采样的主动换道规划方法，其特征是，包括以下步骤：步骤S1：对换道场景的道路进行空间采样处理；步骤S2：对采样点进行横纵向多项式换道轨迹生成求解；步骤S3：对计算出的若干轨迹进行评价函数计算，筛选最优轨迹。2.根据权利要求1所述的一种基于结构化道路采样的主动换道规划方法，其特征是，步骤S1包括以下步骤：步骤S11：对相邻车道线的5次多项式系数进行求和取均值，得到中间车道线的多项式方程；步骤S12：根据得到的参考线，按固定间隔，均匀布置采样点。3.根据权利要求2所述的一种基于结构化道路采样的主动换道规划方法，其特征是，中间车道的多项式方程的内容：其中，leftcoeffs为左道线系数，rightcoeffs为右道线系数。4.根据权利要求2所述的一种基于结构化道路采样的主动换道规划方法，其特征是，步骤S12包括以下内容：采样点的纵向距离间隔为max[4s*Vc
urrentSpeed
,Vs
toppingDistance
]/5，其中，Vc
urrentSpeed
为当前车速，4s*Vc
urrentSpeed
即为当前车速下在4s内的行车距离；Vs
toppingDistance
为当前时速的最大制动距离；采样点横向距离间隔为(load_width
‑
vehicle_width)/2；其中load_width为相邻车道的路宽，vehicle_width为车宽。5.根据权利要求1所述的一种基于结构化道路采样的主动换道规划方法，其特征是，步骤S2包括以下步骤：步骤S21：根据上述步骤得到的采样点，构建车辆运动学模型；步骤S22：根据采样的轨迹点，采用多项式螺旋线来连接轨迹点，生成轨迹曲线。6.根据权利要求5所述的一种基于结构化道路采样的主动换道规划方法，其特征是，车辆运动学模型的内容为：设定车辆姿态向量X＝(x,y,θ,k,v)，其中x,y是二维平面位置，θ是车辆朝向，k表示曲率，v是车辆线速度，其标量大小满足以下关系：7.根据权利要求5所述的一种基于结构化道路采样的主动换道规划方法，其特征是，将轨迹曲线定义为三次多项式螺旋，轨迹的曲率k是弧长s的三次多项式函数，代入参数向量p＝[p
0 p
1 p
2 p
3 s
f
]，其中，...

【专利技术属性】
技术研发人员：赵子瑾，王耀农，林贤德，余伟，张小龙，
申请(专利权)人：浙江零跑科技股份有限公司，
类型：发明
国别省市：