基于智能摄像头和高精地图定位的车道线融合系统及方法技术方案

本发明专利技术公开一种基于智能摄像头和高精地图定位的车道线融合方法，所述方法包括以下步骤：对智能摄像头和高精地图定位控制器输出的车道线信息进行预处理；判断经过预处理的智能摄像头车道线是否存在异常；若出现异常，判断此时高精地图定位器车道线是否可用，若是可用，则选择高精地图定位器输出的车道线来辅助自动驾驶控制；若智能摄像头车道线恢复且可用，则选择智能摄像头输出的车道线来辅助自动驾驶控制；对融合后的车道线进行跟踪验证及处理。本发明专利技术还公开一种基于智能摄像头和高精地图定位的车道线融合系统。通过该系统及方法，在复杂的行驶工况下，实现了智能摄像头和和高精地图定位器有点的互相补充冗余，提高了自动驾驶的安全性和可靠性。

【技术实现步骤摘要】
基于智能摄像头和高精地图定位的车道线融合系统及方法
本专利技术涉及传感器信息融合
，尤其涉及一种基于智能摄像头和高精地图定位的车道线融合系统及方法。
技术介绍
车道线信息是汽车实现自动驾驶最重要的环境感知信息之一。利用车道线信息自动驾驶汽车才能够保持安全行驶在当前车道内。同时，准确平滑的车道线能够使车辆的行驶更加平稳，提升体验感和安全性。目前，自动驾驶汽车获取车道线信息的方式是通过智能摄像头。智能摄像头能够从视频图像中检测识别出车道线，实时输出给自动驾驶控制器。摄像头的优点是感知实时性强，检测较为准确。但摄像头也有易受天气、光线等的影响，视野范围有限，易被障碍物遮挡等缺点。当前的视频图像检测识别技术在弯道、路面阴影、路面标线复杂等特殊工况下的性能不能保证。由于当前摄像头的这些特性，在复杂的行驶工况下，自动驾驶汽车的行驶安全性并不能得到保障。
技术实现思路
本专利技术的目的是提供一种基于智能摄像头和高精地图定位的车道线融合系统及方法，在复杂的行驶工况下，实现了智能摄像头和和高精地图定位器有点的互相补充冗余，提高自动驾驶的安全性和可靠性的。为实现上述目的，本专利技术提供了一种基于智能摄像头和高精地图定位的车道线融合方法，所述方法包括以下步骤：(S1)对智能摄像头输出的车道线信息进行预处理包括：智能摄像头输出车道线的三次曲线，并对三次曲线进行平滑处理；车道线丢失进行补全；车道线合理性判断及异常曲线剔除；(S2)对高精地图定位控制器输出的车道线信息进行预处理包括：将本车经纬度位置、本车航向将地图车道线经纬度点坐标转换到车身坐标系下的相对坐标点，然后拟合成三次曲线，并对三次曲线进行平滑处理；车道线合理性判断及异常曲线剔除；(S3)判断经过预处理的智能摄像头输出的车道线是否存在异常；若智能摄像头输出的车道线没有异常时，则选择智能摄像头输出的车道线来辅助自动驾驶控制；若智能摄像头输出的车道线出现异常，需判断此时高精地图定位器输出的车道线是否可用，若是可用的，则选择高精地图定位器输出的车道线来辅助自动驾驶控制，所述智能摄像头输出的车道线平稳过渡到高精地图定位器输出的车道线上以实现融合；若智能摄像头输出的车道线恢复，判定智能摄像头输出的车道线可用，则选择智能摄像头输出的车道线来辅助自动驾驶控制，高精地图定位器输出的车道线平稳过渡到智能摄像头输出的车道线上以实现融合；(S4)对融合后的车道线进行跟踪验证及处理，以输出准确、稳定且可靠的车道线来辅助自动驾驶控制。进一步，在步骤(S1)和步骤(S2)中，将三次曲线进行平滑处理，具体步骤为：对三次曲线的系数用可变权重的低通滤波器使其平滑化。进一步，在步骤(S1)中，对车道线丢失进行补全，具体步骤包括包括：对单侧车道线丢失根据历史车道宽进行平移补全；对左右车道线全部丢失的情况根据历史数据进行预测然后补全。进一步，在步骤(S3)中，所述智能摄像头输出的车道线平稳过渡到高精地图定位器输出的车道线上以实现融合，具体包括以下步骤：若高精地图定位器输出的车道线可用，根据车辆行驶状态以智能摄像头历史输出的车道线预测下一帧车道线拟合成三次曲线的车道线参数A0、A1、A2和A3；根据经验值每次以A0最大跳变0.05，A1最大跳变0.001，A2最大跳变0.00001，A3最大跳变0.000001作为当前的车道线参数输出，直至过渡到以当前高精地图定位器输出的车道线作为融合输出车道线。进一步，判断此时高精地图定位器车道线是否可用，需同时对以下两种情况进行判定:一是高精地图定位器的精度和置信度是否满足使用要求；二是高精地图定位器车道线与摄像头历史及预测车道线的平均横向误差是否稳定小于20厘米，以及是否有异常跳变；若高精地图定位器的精度和置信度满足使用要求，以及高精地图定位器车道线与摄像头历史及预测车道线的平均横向误差稳定小于20厘米且无异常跳变，则高精地图定位器车道线可用，否则高精地图定位器车道线不可用。进一步，当无标志物对定位进行纵向校正时，纵向定位会有米级的纵向误差；在直道且车道无特殊变化时，纵向误差对车道线的准确度影响小，此时高精地图定位器输出的车道线具有高置信度；在弯道时，纵向误差对车道线的准确度影响大，此时高精地图定位器输出的车道线具有低置信度，弯道曲率越大，置信度越低；如果地图车道线不可用，则车道线的置信度为0。进一步，当车道线具有低置信度或置信度为0，获取前车轨迹进行跟车或根据历史推测来辅助自动驾驶控制。进一步，在步骤(S1)和(S2)中，所述车道线合理性判断包括：对车道线的三次曲线系数A0、A1、A2、A3的范围及帧间跳变的范围合理性进行判断；对车道宽度的合理性判断；对车道线长度的合理性判断。本专利技术还提供一种基于智能摄像头和高精地图定位的车道线融合系统，包括：智能摄像头，用于输出车道线信息；所述智能摄像头与车身CAN总线连接；GPS接收机，用于接收全球定位系统卫星信号并确定地面空间位置；惯性传感器，用于输出IMU信号；高精地图定位控制器，用于完成硬件系统初始化、定位算法初始化及输出车道线信息；所述高精地图定位控制器与车身CAN总线连接；所述高精地图定位控制器还与智能摄像头、GPS接收机和惯性传感器连接；自动驾驶控制器，所述自动驾驶控制器用于执行本专利技术的步骤(S3)和步骤(S4)；所述智能摄像头和高精地图定位控制器均与自动驾驶控制器连接。进一步，所述智能摄像头为前视智能摄像头且具有ASILB级功能安全的智能摄像头。本专利技术与现有技术相比较具有以下优点：本专利技术的基于智能摄像头和高精地图定位的车道线融合系统及方法，采用智能摄像头完成车道线检测和高精地图定位器输出预存车道线，对二者输出的目标级车道线信息进行融合，并对车道线本身进行平滑及平稳过渡处理生成更稳定的车道线，生成了用于自动驾驶横向控制的更稳定、可靠的车道线，实现了两种传感器优点的互相补充冗余，提升了安全性和体验感；通过对三次曲线的平滑处理以防止异常跳变；以及在车道线切换到过程融合算法输出的车道线要引导车辆平稳过渡，可以进一步防止车道线跳变，提升安全性和体验感。附图说明图1为本专利技术基于智能摄像头和高精地图定位的车道线融合方法的流程图；图2为本专利技术基于智能摄像头和高精地图定位的车道线融合系统的结构示意图。图中：1-智能摄像头；2-高精地图定位控制器；3-自动驾驶控制器；4-GPS接收机；5-惯性传感器。具体实施方式下面结合附图对本专利技术的具体实施方式作进一步说明。高精地图是专门服务于自动驾驶的地图，具有更高的精度和更丰富的信息，储存了车道级道路信息，以及标牌、杆等固定标志物信息。定位算法融合GPS、IMU、轮速及摄像头等传感器输入信号，实现本车车道级精确定位。通过精确位置与高精地图的匹配，来获取该位置相应车道级的环境信息。参见图1所示，本实施例公开了一种基于智能摄像头和高精地图定位的车道线融合方法，所本文档来自技高网...

【技术保护点】
1.一种基于智能摄像头和高精地图定位的车道线融合方法，其特征在于，所述方法包括以下步骤：/n(S1)对智能摄像头(1)输出的车道线信息进行预处理包括：智能摄像头(1)输出车道线的三次曲线，并对三次曲线进行平滑处理；车道线丢失进行补全；车道线合理性判断及异常曲线剔除；/n(S2)对高精地图定位控制器(2)输出的车道线信息进行预处理包括：将本车经纬度位置、本车航向将地图车道线经纬度点坐标转换到车身坐标系下的相对坐标点，然后拟合成三次曲线，并对三次曲线进行平滑处理；车道线合理性判断及异常曲线剔除；/n(S3)判断经过预处理的智能摄像头(1)输出的车道线是否存在异常；若智能摄像头(1)输出的车道线没有异常时，则选择智能摄像头(1)输出的车道线来辅助自动驾驶控制；/n若智能摄像头(1)输出的车道线出现异常，需判断此时高精地图定位器(2)输出的车道线是否可用，若是可用的，则选择高精地图定位器(2)输出的车道线来辅助自动驾驶控制，所述智能摄像头(1)输出的车道线平稳过渡到高精地图定位器(2)输出的车道线上以实现融合；/n若智能摄像头(1)输出的车道线恢复，判定智能摄像头(1)输出的车道线可用，则选择智能摄像头输出的车道线来辅助自动驾驶控制，高精地图定位器(2)输出的车道线平稳过渡到智能摄像头(1)输出的车道线上以实现融合；/n(S4)对融合后的车道线进行跟踪验证及处理，以输出准确、稳定且可靠的车道线来辅助自动驾驶控制。/n...

【技术特征摘要】
1.一种基于智能摄像头和高精地图定位的车道线融合方法，其特征在于，所述方法包括以下步骤：
(S1)对智能摄像头(1)输出的车道线信息进行预处理包括：智能摄像头(1)输出车道线的三次曲线，并对三次曲线进行平滑处理；车道线丢失进行补全；车道线合理性判断及异常曲线剔除；
(S2)对高精地图定位控制器(2)输出的车道线信息进行预处理包括：将本车经纬度位置、本车航向将地图车道线经纬度点坐标转换到车身坐标系下的相对坐标点，然后拟合成三次曲线，并对三次曲线进行平滑处理；车道线合理性判断及异常曲线剔除；
(S3)判断经过预处理的智能摄像头(1)输出的车道线是否存在异常；若智能摄像头(1)输出的车道线没有异常时，则选择智能摄像头(1)输出的车道线来辅助自动驾驶控制；
若智能摄像头(1)输出的车道线出现异常，需判断此时高精地图定位器(2)输出的车道线是否可用，若是可用的，则选择高精地图定位器(2)输出的车道线来辅助自动驾驶控制，所述智能摄像头(1)输出的车道线平稳过渡到高精地图定位器(2)输出的车道线上以实现融合；
若智能摄像头(1)输出的车道线恢复，判定智能摄像头(1)输出的车道线可用，则选择智能摄像头输出的车道线来辅助自动驾驶控制，高精地图定位器(2)输出的车道线平稳过渡到智能摄像头(1)输出的车道线上以实现融合；
(S4)对融合后的车道线进行跟踪验证及处理，以输出准确、稳定且可靠的车道线来辅助自动驾驶控制。


2.根据权利要求1所述的基于智能摄像头和高精地图定位的车道线融合方法，其特征在于，在步骤(S1)和步骤(S2)中，将三次曲线进行平滑处理，具体步骤为：对三次曲线的系数用可变权重的低通滤波器使其平滑化。


3.根据权利要求1所述的基于智能摄像头和高精地图定位的车道线融合方法，其特征在于，在步骤(S1)中，对车道线丢失进行补全，具体步骤包括：对单侧车道线丢失根据历史车道宽进行平移补全；对左右车道线全部丢失的情况根据历史数据进行预测然后补全。


4.根据权利要求1所述的基于智能摄像头和高精地图定位的车道线融合方法，其特征在于，在步骤(S3)中，所述智能摄像头(1)输出的车道线平稳过渡到高精地图定位器(2)输出的车道线上以实现融合，具体包括以下步骤：根据车辆行驶状态以智能摄像头历史输出的车道线预测下一帧车道线拟合成三次曲线的车道线参数A0、A1、A2和A3；根据经验值每次以A0最大跳变0.05，A1最大跳变0.001，A2最大跳变0.00001，A3最大跳变0.000001作为当前的车道线参数输出，直至过渡到以当前高精地图定位器(2)输出的车道线作为融合输出车道线。


5.根据权利要求1所述的基于...

【专利技术属性】
技术研发人员：汤兆丰，熊周兵，
申请(专利权)人：重庆长安汽车股份有限公司，
类型：发明
国别省市：重庆;50