自动驾驶进入匝道的控制系统、方法、车辆及存储介质与流程

技术特征：
1.一种自动驾驶进入匝道的控制方法，其特征在于，包括以下步骤：步骤1，进入匝道条件判断，判断导航路径以及本车状态是否满足自动进入匝道条件，若满足，则进入步骤2，否则，继续执行步骤1；步骤2，匝道区域场景重构，通过摄像头进行车道线识别，要求摄像头至少识别到主路右侧车道线（6）和匝道右侧车道线（4），并通过计算主路右侧车道线（6）和匝道右侧车道线（4）的起始相交点得到匝道的起始点（2），并将主路右侧车道线（6）作为匝道的左边界线，将匝道右侧车道线（4）作为匝道的右边界线，并进行轨迹规划进入匝道；在摄像头检测到匝道左侧车道线（5）时，将匝道左侧车道线（5）与主路右侧车道线（6）的相交点（3）作为该匝道入口的终点，此时匝道的右边界保持跟踪匝道右侧车道线（4），匝道左边界更新为主路右侧车道线（6）和匝道左侧车道线（5）两条车道线的组合；步骤3，匝道可通行状态确认，从雷达原始点云以及摄像头的可通行区域分割点云中，提取出表征道路边界护栏的点，判断是否重构出的匝道区域是否是可通行状态，作为安全校验；若匝道口判断为不可通行，则提示驾驶员接管车辆；若匝道口判断为可通行，进入步骤4；步骤4，匝道区域路径规划，根据导航信息进入匝道后靠左侧或靠右侧行驶，对应选择匝道的左、右侧边界作为规划的参考线进行轨迹规划，生成三次多项式曲线方程；步骤5，轨迹有效性判断，判断生成的三次多项式曲线方程是否为控制可跟随，是否与其他目标存在碰撞风险，若为控制可跟随且与其他目标不存在碰撞风险，则认为轨迹有效，将轨迹给到控制器控制车辆进入匝道，否则认为轨迹无效，则提示驾驶员接管车辆。2.根据权利要求1所述的自动驾驶进入匝道的控制方法，其特征在于：所述步骤1中，条件包括：条件1a.本车处于导航辅助驾驶状态，即已开启响应驾驶辅助功能且已设置导航目的地；条件1b.本车位于导航辅助驾驶可用的电子围栏区域内；条件1c.本车处于进入匝道判定区域，导航路径提示还有预设距离进入匝道；条件1d.本车处于匝道相邻的车道；条件1f.本车速度处于可进入匝道的速度区间；若以上条件均满足，则进入步骤2，否则，继续执行步骤1。3.根据权利要求1或2所述的自动驾驶进入匝道的控制方法，其特征在于：当距离匝道入口终点过近，判断已无法规划有效轨迹时，保持在当前车道行驶且同时提示驾驶员接管。4.根据权利要求3所述的自动驾驶进入匝道的控制方法，其特征在于：所述预设距离为50m。5.一种自动驾驶进入匝道的控制系统，其特征在于，包括卫星定位模块、导航地图模块、摄像头模块、毫米波雷达模块、控制器和存储器；所述卫星定位模块用于提供车辆的定位信息，定位精度为米级；所述导航地图模块用于结合卫星定位模块给出前方匝道起点距离，以及进入匝道后靠左或靠右侧行驶的路径信息；所述摄像头模块用于输出当前车道和相邻车道的车道线曲线方程、前方目标信息以及前方可通行区域点；
所述毫米波雷达模块用于输出车辆目标信息，以及雷达反射点数据；所述存储器内存储有计算机可读程序；所述控制器调用所述计算机可读程序时，能执行如权利要求1至4任一所述的自动驾驶进入匝道的控制方法的步骤。6.根据权利要求5所述的自动驾驶进入匝道的控制系统，其特征在于：所述摄像头模块为前视摄像头。7.根据权利要求5或6所述的自动驾驶进入匝道的控制系统，其特征在于：所述毫米波雷达模块包括前向长距毫米波雷达和侧向中距毫米波雷达。8.根据权利要求7所述的自动驾驶进入匝道的控制系统，其特征在于：所述导航地图模块为车道导航地图，用于提供导航路径和匝道信息。9.一种车辆，其特征在于：采用如权利要求5至8任一所述的自动驾驶进入匝道的控制系统。10.一种存储介质，其特征在于：其内存储有计算机可读程序，所述计算机可读程序被调用时，能执行如权利要求1至4任一所述的自动驾驶进入匝道的方法的步骤。

技术总结
本发明公开了自动驾驶进入匝道的控制系统、方法、车辆及存储介质，包括以下步骤：步骤1，进入匝道条件判断；步骤2，匝道区域场景重构；步骤3，匝道可通行状态确认；步骤4，匝道区域路径规划；步骤5，轨迹有效性判断。本发明充分运用目前主流驾驶辅助传感器信息，通过摄像头检测车道线信息，重构匝道入口场景，并结合雷达护栏点检测以及摄像头可通行区域结果判断碰撞风险，提升进入匝道过程的安全性。提升进入匝道过程的安全性。提升进入匝道过程的安全性。


技术研发人员：贺勇 王月强 韩亚奇 孔周维
受保护的技术使用者：重庆长安汽车股份有限公司
技术研发日：2021.06.30
技术公布日：2021/10/8