一种适用于结构化道路的自主换道控制方法及系统技术方案

本发明专利技术公开了一种适用于结构化道路的自主换道控制方法及系统，首先计算最小换道安全距离；若最小换道安全距离小于相对距离，计算换道路径；根据换道路径计算换道感兴趣区域ROI(Region Of Interest);根据感知系统反馈的局部交通信息，判断换道感兴趣区域ROI中是否存在障碍物；若感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，根据全局参考路径计算侧后向感兴趣区域ROI；若侧后向感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，执行换道动作。本发明专利技术提供一种适用于结构化道路的自主换道控制方法及系统，优化自动驾驶控制。

【技术实现步骤摘要】
一种适用于结构化道路的自主换道控制方法及系统
本专利技术涉及自动驾驶
，具体涉及一种适用于结构化道路的自主换道控制方法及系统。
技术介绍
随着自动驾驶技术的高速发展，高级驾驶辅助系统(ADAS,AdvancedDriverAssistanceSystems)已经被人们所熟知。其中，自适应巡航控制系统(ACC,AdaptiveCruiseControlSystem)、自动紧急制动系统(AEB,AutonomousEmergencyBraking)及换道辅助系统(LCA,LaneChangeAssistance)作为能够提升行驶安全、改善交通拥堵和缓解驾驶疲劳的典型的高级驾驶辅助子系统，已经得到研究机构、传统汽车企业及互联网企业的广泛认可与关注。但是，ACC系统和AEB系统的研究主要通过车辆的纵向控制提升行驶安全及提高通行效率，而LCA系统也表现出诸多的局限性，甚至对车辆正常驾驶造成干扰，现有LCA系统适用工况简单，驾驶员对系统的人工干预频率过高，不能有效地降低驾驶疲劳，使驾驶员仍处于精神高度紧张的状态。因此，现有LCA系统不能兼顾自车通行效率的高效性、自车在局部交通流中的换道行为的安全性和用户体验的舒适性；现有LCA系统适用工况简单，驾驶员对系统的人工干预频率过高，不能有效地降低驾驶疲劳，使驾驶员仍处于精神高度紧张的状态。所以市场上需要一种适用于30km/h及以下，可以适应结构化道路下不同复杂工况的自动驾驶的换道控制方法及系统。
技术实现思路
本专利技术目的是：提供一种适用于结构化道路的自主换道控制方法及系统，实现自动驾驶的目的。本专利技术的技术方案是：一种适用于结构化道路的自主换道控制方法，包括以下步骤：S01:计算最小换道安全距离；S02:若最小换道安全距离小于相对距离，计算换道路径；S03:根据换道路径计算换道感兴趣区域ROI(RegionOfInterest)；S04:根据感知系统反馈的局部交通信息，判断换道感兴趣区域ROI中是否存在障碍物；S05:若感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，根据全局参考路径计算侧后向感兴趣区域ROI；S06:若侧后向感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，执行换道动作。在一个实施例中，最小换道安全距离计算方法为：Dmin＝THWlc*Vhost+Dsafe，其中，Dmin为最小换道安全距离，Vhost为自车速度，Dsafe为安全距离,THWlc为为车头时距,可根据用户的驾驶偏好调整。在一个实施例中，换道路径的计算方法包括：根据三次多项式y＝ax3+bx2+cx+d计算实时换道路径，其中车体坐标x轴正方向为车头朝向，x的取值为Dmin*n/N(n＝0,1,2,…,N-1),N为局部路径离散点数量，Dmin为最小换道安全距离，y的幅值小于路宽。在一个实施例中，换道感兴趣区域ROI的计算方法包括：沿着换道路径的法线方向取一定宽度的区域为换道的感兴趣区域ROI。在一个实施例中，侧后向感兴趣区域ROI的计算方法包括：以参考路径和自车为参考，取邻车道和自车车头后方的区域为侧后向的感兴趣区域ROI。在一个实施例中，根据计算的方向盘转角来执行换道动作，方向盘转角的计算方法为：结合单点预瞄模型控制方法，计算预瞄点(x1，y1)，其中，x1＝x0+Dpre*cosθ，y1＝y0+Dpre*sinθ，(x0，y0)为自车的实时坐标，Dpre为自车预瞄距离，θ＝-courseAngle+π/2,courseAngle为自车的航向角，设置一个方向盘转角的PID控制器，其输入为e，e为预瞄点与途中预瞄点的距离，输出u为自车的方向盘目标转角。本专利技术还提供一种适用于结构化道路的自主换道控制系统，包括以下模块：感知模块，检测自车周围的局部交通状况，反馈检测到的障碍物信息；定位模块，根据实时动态RTK及高清地图HDmap信息，对自车进行精准的定位；全局路径规划模块，根据自车的起点、终点以及全局路网信息，规划出一条车道级的全局参考路径；规划决策模块，结合参考路径、局部交通信息、车辆动力学，生成出一条最优的局部路径，根据该路径计算出目标车速及目标方向盘转角；控制模块，控制车辆快速、稳定、精确的相应决策给出的控制目标。本专利技术的优点是：本专利技术所设计的自主换道系统能有效解决自车通行效率的高效性、自车在局部交通流中的换道行为的安全性和用户体验的舒适性等多目标协调优化问题；适用更多复杂工况，降低驾驶员对系统的人工干预频率，有效地降低驾驶疲劳，使驾驶员处于相对松弛的精神状态。附图说明下面结合附图及实施例对本专利技术作进一步描述：图1为本专利技术实施例自主换道流程图；图2为本专利技术实施例局部路径规划示意图；图3为本专利技术实施例换道感兴趣区域示意图；图4为本专利技术实施例侧后向感兴趣区域示意图；图5为本专利技术实施例轨迹跟踪算法示意图。具体实施方式以下结合附图对本专利技术的原理和特征进行描述，所举实例只用于解释本专利技术，并非用于限定本专利技术的范围。本专利技术针对结构化道路下的不同复杂工况进行合理的规划决策，给出适用于车速30km/h及以下不同复杂工况的最优换道路径(局部路径)，可实现车辆的通行高效性、车辆安全性，用户体验舒适性的多目标协调优化。如图1所示，一种适用于结构化道路的自主换道控制方法，包括以下步骤：S01:计算最小换道安全距离；S02:若最小换道安全距离小于相对距离，计算换道路径；S03:根据换道路径计算换道感兴趣区域ROI(RegionOfInterest)；S04:根据感知系统反馈的局部交通信息，判断换道感兴趣区域ROI中是否存在障碍物；S05:若感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，根据全局参考路径计算侧后向感兴趣区域ROI；S06:若侧后向感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，执行换道动作。上述实施例，具体的，最小换道安全距离计算方法为：Dmin＝THWlc*Vhost+Dsafe，其中，Dmin为最小换道安全距离，Vhost为自车速度，Dsafe为安全距离,THWlc为车头时距，可根据用户的驾驶偏好调整；在具体的实施例中，换道路径的计算方法为，如图2所示，根据三次多项式y＝ax3+bx2+cx+d计算实时换道路径，其中车体坐标x轴正方向为车头朝向，x的取值为Dmin*n/N(n＝0,1,2,…,N-1),N为局部路径离散点数量，Dmi为最小换道安全距离，y的幅值小于路宽。优选的，换道感兴趣区域ROI的计算方法包括：如图3所示，沿着换道路径的法线方向取一定宽度的区域为换道的感兴趣区域ROI。优选的，侧后向感兴趣区域ROI的计算方法包括：如图4所示，以参考路径和自车为参考，取邻车道和自车车头后方的区域为侧后向的感兴趣区域ROI。优选的，根据计算的方向盘转角来执行换道动作，方向盘转角的计算方法为：如图5所示，结合单点预瞄模型控制方法，计算预瞄点(x1，y1)，其中，x1＝x0+Dpre*cosθ，y1＝y0+Dpre*sinθ，(x0，y0)为自车的实时坐标，Dpre自车预瞄距离，θ＝-courseAngle+π/2,courseAngle为自车的航向角，设置一个方向盘转角的PID控制器，其输入为e，e为预瞄点与途中预瞄点的距离，输出u为自本文档来自技高网...

【技术保护点】
1.一种适用于结构化道路的自主换道控制方法，其特征在于，包括以下步骤：S01:计算最小换道安全距离；S02:若最小换道安全距离小于相对距离，计算换道路径；S03:根据换道路径计算换道感兴趣区域ROI(Region Of Interest)；S04:根据感知系统反馈的局部交通信息，判断换道感兴趣区域ROI中是否存在障碍物；S05:若感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，根据全局参考路径计算侧后向感兴趣区域ROI；S06:若侧后向感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，执行换道动作。

【技术特征摘要】
1.一种适用于结构化道路的自主换道控制方法，其特征在于，包括以下步骤：S01:计算最小换道安全距离；S02:若最小换道安全距离小于相对距离，计算换道路径；S03:根据换道路径计算换道感兴趣区域ROI(RegionOfInterest)；S04:根据感知系统反馈的局部交通信息，判断换道感兴趣区域ROI中是否存在障碍物；S05:若感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，根据全局参考路径计算侧后向感兴趣区域ROI；S06:若侧后向感兴趣区域ROI中无障碍物或感兴趣区域ROI中的障碍物无风险，执行换道动作。2.如权利要求1所述适用于结构化道路的自主换道控制方法，其特征在于，最小换道安全距离计算方法为：Dmin＝THWlc*Vhost+Dsafe，其中，Dmin为最小换道安全距离，Vhost为自车速度，Dsafe为安全距离，THWlc为车头时距，可根据用户的驾驶偏好调整。3.如权利要求1所述适用于结构化道路的自主换道控制方法，其特征在于，换道路径的计算方法包括：根据三次多项式y＝ax3+bx2+cx+d计算实时换道路径，其中车体坐标x轴正方向为车头朝向，x的取值为Dmin*n/N(n＝0,1,2,…,N-1),N为局部路径离散点数量，Dmin为最小换道安全距离，y的幅值小于路宽，系数a、b、c、d可通过实际约束条件求解。4.如权利要求1所述适用于结构化道路的自主换道控制方法，其特征在于，换道感兴趣区域RO...

【专利技术属性】
技术研发人员：徐巍，戴一凡，韩海兰，
申请(专利权)人：清华大学苏州汽车研究院吴江，
类型：发明
国别省市：江苏,32