(12)发明专利申请
(10)申请公布号 CN 112241007 A(43)申请公布日 2021.01.19
(21)申请号 202010618016.4(22)申请日 2020.07.01
(71)申请人 北京新能源汽车技术创新中心有限
公司
地址 100089 北京市大兴区北京经济技术
开发区荣华中路10号1幢A座1705 100176(72)发明人 张婷 原诚寅 朱明哲 周玉祥 (74)专利代理机构 北京一品慧诚知识产权代理
有限公司 11762
代理人 邓树山(51)Int.Cl.
G01S 13/86(2006.01)G01S 7/40(2006.01)G01S 7/497(2006.01)
权利要求书3页 说明书10页 附图4页
G01S 7/52(2006.01)B60R 11/00(2006.01)G06T 7/70(2017.01)G06T 7/80(2017.01)
CN 112241007 A(54)发明名称
布置自动驾驶环境感知传感器的标定方法、
结构及车辆(57)摘要
本发明涉及自动驾驶传感器领域,具体涉及一种自动驾驶环境感知传感器的标定方法、布置结构及车辆;所述标定方法针对不同的传感器采用不同的标定方法,基于对激光点云等数据的利用及处理,将不同传感器的坐标系通过不同的方法进行相对于车辆坐标系的位姿变换,提升了自动驾驶环境感知传感器标定的自动化程度,且精确性高,满足多传感器融合的要求;所述布置结构为在满足车体360度均覆盖的同时,实现一定程度的传感器冗余,当个别传感器出现故障的情况下,可以正常进行周围环境的监测,提升了自动驾驶安全性的,而且,通过本实施例布置方法能够在保证感知性能的前提下,实现最大限度的相互配合,尽可能减少传感器的使用数量,有效降低了成本。
CN 112241007 A
权 利 要 求 书
1/3页
1.一种自动驾驶环境感知传感器的标定方法,其特征在于,所述标定方法包括:建立车辆坐标系;
基于激光雷达发送的地面点云数据建立平整地面的平面方程,确定激光雷达坐标系相对于车辆坐标系的位姿变换关系;
匹配同一场景的激光雷达的点云数据及摄像头的图像数据的边缘点,根据摄像头和激光雷达的坐标系变换关系确定所述摄像头坐标系相对于车辆坐标系的位姿变换关系;
通过激光雷达与毫米波雷达数据检测毫米波反射器的位置计算所述毫米波雷达的坐标系参数,确定毫米波雷达坐标系相对于车辆坐标系的位姿变换关系;
比较激光雷达和超声波雷达检测的移动目标的位置差异,确定超声波雷达的位置坐标。
2.如权利要求1所述的自动驾驶环境感知传感器的标定方法,其特征在于,所述“基于激光雷达发送的地面点云数据建立平整地面的平面方程,确定激光雷达坐标系相对于车辆坐标系的位姿变换关系”的方法包括:
测量激光雷达的初始安装位置,结合车辆坐标系确定x轴、y轴方向的偏移量Δx、Δy;接收激光雷达发送的地面点云数据,获取地面点云的三维坐标,采用最小二乘法拟合地面的平面方程,建立地面平整度函数为优化目标函数,以翻滚角α、俯仰角β为待优化参数,采用BP神经网络方法求解最优值;
利用平面方程确定相对z轴方向的偏移量Δz;基于深度学习的激光点云目标物识别结果,采用优化算法求解偏航角最优值γ。3.如权利要求2所述的自动驾驶环境感知传感器的标定方法,其特征在于,所述“基于深度学习的激光点云目标物识别结果,采用优化算法求解最优偏航角值γ”的方法包括:
在车辆坐标系的x轴上设置标定物,将所述标定物放在在车辆正前方的预设距离内,设置初始偏航角值γ;
接收激光雷达检测标定物的点云数据,根据所述Δx、Δy、Δz、α、β、γ,将点云数据从激光雷达坐标系转换到车辆坐标系下;
建立Pointnet深度学习网络,识别点云数据中的标定物,确定标定物的位置,采用梯度下降法求解最优γ。
4.如权利要求1所述的自动驾驶环境感知传感器的标定方法,其特征在于,所述“匹配同一场景的激光雷达的点云数据及摄像头的图像数据的边缘点,根据摄像头和激光雷达的坐标系变换关系确定所述摄像头坐标系相对于车辆坐标系的位姿变换关系”的方法包括:
利用张正友标定法标定摄像头内参;确定标定场景,获取雷达激光及摄像头在标定场景下针对移动的标定板的点云数据及图像数据;
提取并匹配所述点云数据及图像数据的边缘点;
根据匹配关系求解摄像头坐标系和激光雷达坐标系之间的变换关系。5.如权利要求1所述的自动驾驶环境感知传感器的标定方法,其特征在于,所述“通过激光雷达与毫米波雷达数据检测毫米波反射器的位置计算所述毫米波雷达的坐标系参数,确定毫米波雷达坐标系相对于车辆坐标系的位姿变换关系”的方法包括:
获取毫米波雷达安装时的α、β、Δz;
2
CN 112241007 A
权 利 要 求 书
2/3页
根据车辆坐标系计算毫米波雷达的Δx、Δy;
获取激光雷达及毫米波雷达针对毫米波反射器的激光点云数据和毫米波雷达数据,以从激光点云数和毫米波雷达检测到的毫米波反射器位置重叠为目标,采用梯度下降法求解最优的偏航角γ。
6.如权利要求1所述的自动驾驶环境感知传感器的标定方法,其特征在于,所述“比较激光雷达和超声波雷达检测的移动目标的位置差异,确定超声波雷达的位置坐标”的方法包括:
测量超声波雷达安装的位置,根据车辆坐标系计算所述超声波雷达的初始位置坐标;设置移动目标,获取激光雷达及超声波雷达针对移动目标的激光点云数据及超声波雷达数据;
比较激光点云数据及超声波雷达数据的位置差异,确定超声波雷达的位置坐标。7.一种自动驾驶环境感知传感器的布置结构,其特征在于,包括设置在车辆顶部上方的激光雷达;交错设置在车辆四周的中距毫米波雷达、超声波雷达及360度环视摄像头;设置在车辆前方的长距毫米波雷达,设置在车辆前风挡内容部的前置摄像头,所述激光雷达的线束接头、长距毫米波雷达、前置摄像头与车辆中轴线重合,所述中距毫米波雷达、超声波雷达及360度环视摄像头对称设置。
8.如权利要求7所述的自动驾驶环境感知传感器的布置结构,其特征在于,所述布置结构还包括:
设置有一个所述激光雷达,所述激光雷达通过支架安装在车顶,所述激光雷达与车顶设置高度为20-30cm,用于获取车辆周围准确的三维信息;和/或
设置有四个所述中距毫米波雷达,分别设置在车辆前后保险杠的两侧,左右对称布置,位于前保险杠两侧的所述中距毫米波雷达与车辆行驶方向设置为第一夹角,位于后保险杠两侧的所述中距毫米波雷达与车辆行驶方向设置为第二夹角,所述第一夹角大于第二夹角,用于检测车身四周障碍物;和/或
设置有十二个所述超声波雷达,所述超声波雷达包括8个超声波驻车辅助类型雷达和4个自动泊车辅助类型雷达,所述超声波驻车辅助类型雷达分别位于车辆前、后保险杠,用于探测车辆前后障碍物;所述自动泊车辅助类型雷达安装在车辆前、后保险杠四角,呈左右对称布置,用于探测侧方停车空间;和/或
设置有四个所述360度环视摄像头,分别位于车辆前、后保险杠及两侧后视镜,位于车辆前、后保险杠的所述360度环视摄像头设置在车辆中轴线上,设置与保险杠前端,与地面呈第三角度夹角,位于两侧后视镜的所述360度环视摄像头的中轴线与地面呈第四角度夹角;设置在外后视镜下表面;用于感知近距离物体;和/或
设置有一个所述长距毫米波雷达,位于车辆前方的保险杠内,所述长距毫米雷达与保险杠表面距离设置在50-150mm,与地面的距离设置50-80cm,所述长距毫米雷达用于检测前方障碍物;和/或
设置一个所述前置摄像头与车辆中轴线上,位于车辆的前挡风玻璃的上边缘内侧,用于识别前方路面信息;和/或
所述布置结构还设置有一个内置摄像头,位于驾驶员对面,用于检测驾驶员疲劳状况。9.如权利要求7或8任意一项所述的自动驾驶环境感知传感器的布置结构,其特征在
3
CN 112241007 A
权 利 要 求 书
3/3页
于,所述布置结构中的激光雷达、中距毫米波雷达、长距毫米波雷达、超声波雷达、前置摄像头通过如权利要求1-6任意一项所述的自动驾驶环境感知传感器的标定方法进行标定。
10.一种车辆,其特征在于,所述车辆包括如权利要求7-9任意所述的自动驾驶环境感知传感器的布置结构。
4
CN 112241007 A
说 明 书
1/10页
自动驾驶环境感知传感器的标定方法、布置结构及车辆
技术领域
[0001]本发明涉及自动驾驶传感器领域,具体涉及一种自动驾驶环境感知传感器的标定方法、布置结构及车辆。背景技术
[0002]自动驾驶需要传感器进行环境检测,目前采用的激光雷达、摄像头、毫米波雷达、超声波雷达等几类传感器各有优缺点,在特性上都有所差异,需要进行多传感器信息融合,相互补充,发挥各传感器的优点,才能实现精确的感知,进而保证自动驾驶车辆的安全行驶。
[0003]基于技术和成本的考虑,当前的自动驾驶汽车主要应用于特定场景。现有技术中自动驾驶车辆对前方、侧前方、侧向、侧后方和后方的感知范围和检测要求不同,而且不同的场景需要实现不同的功能,故自动驾驶系统根据不同的感知需求,对感知传感器的布置要求也不同;另外,对于感知传感器的标定,现有技术中,传感器的标定方法通常是每种传感器建立自己的独立坐标系,或者不同的传感器按照相同的方法进行标定;标定方法实施复杂、过程繁琐,需要大量人工操作,影响标定效率和标定精度。[0004]综上所述,目前自动驾驶领域中,环境感知传感器的布置和标定存在着精度低,安全性能等差等不足,故设计一种能够实现准确性和自动化程度较高的感知传感器标定及布置结构十分必要。
发明内容
[0005]鉴于现有技术中存在的技术缺陷和技术弊端,本发明实施例提供克服上述问题或者至少部分地解决上述问题的一种自动驾驶环境感知传感器的标定方法、布置结构及车辆,提升了标定的自动化程度及准确性,且能够保证安全自动驾驶安全性的同时,有效降低成本。
[0006]作为本发明实施例的一个方面,提供了一种自动驾驶环境感知传感器的标定方法,所述标定方法包括:[0007]建立车辆坐标系;
[0008]基于激光雷达发送的地面点云数据建立平整地面的平面方程,确定激光雷达坐标系相对于车辆坐标系的位姿变换关系;
[0009]匹配同一场景的激光雷达的点云数据及摄像头的图像数据的边缘点,根据摄像头和激光雷达的坐标系变换关系确定所述摄像头坐标系相对于车辆坐标系的位姿变换关系;[0010]通过激光雷达与毫米波雷达数据检测毫米波反射器的位置计算所述毫米波雷达的坐标系参数,确定毫米波雷达坐标系相对于车辆坐标系的位姿变换关系;[0011]比较激光雷达和超声波雷达检测的移动目标的位置差异,确定超声波雷达的位置坐标。
[0012]进一步地,所述“基于激光雷达发送的地面点云数据建立平整地面的平面方程,确
5
CN 112241007 A
说 明 书
2/10页
定激光雷达坐标系相对于车辆坐标系的位姿变换关系”的方法包括:[0013]测量激光雷达的初始安装位置,结合车辆坐标系确定x轴、y轴方向的偏移量Δx、Δy;
[0014]接收激光雷达发送的地面点云数据,获取地面点云的三维坐标,采用最小二乘法拟合地面的平面方程,建立地面平整度函数为优化目标函数,以翻滚角α、俯仰角β为待优化参数,采用BP神经网络方法求解最优值;[0015]利用平面方程确定相对z轴方向的偏移量Δz;[0016]基于深度学习的激光点云目标物识别结果,采用优化算法求解偏航角最优值γ。[0017]进一步地,所述“基于深度学习的激光点云目标物识别结果,采用优化算法求解最优偏航角值γ”的方法包括:
[0018]在车辆坐标系的x轴上设置标定物,将所述标定物放在在车辆正前方的预设距离内,设置初始偏航角值γ;
[0019]接收激光雷达检测标定物的点云数据,根据所述Δx、Δy、Δz、α、β、γ,将点云数据从激光雷达坐标系转换到车辆坐标系下;[0020]建立Pointnet深度学习网络,识别点云数据中的标定物,确定标定物的位置,采用梯度下降法求解最优γ。[0021]进一步地,所述“匹配同一场景的激光雷达的点云数据及摄像头的图像数据的边缘点,根据摄像头和激光雷达的坐标系变换关系确定所述摄像头坐标系相对于车辆坐标系的位姿变换关系”的方法包括:[0022]利用张正友标定法标定摄像头内参;[0023]确定标定场景,获取雷达激光及摄像头在标定场景下针对移动的标定板的点云数据及图像数据;
[0024]提取并匹配所述点云数据及图像数据的边缘点;
[0025]根据匹配关系求解摄像头坐标系和激光雷达坐标系之间的变换关系。[0026]进一步地,所述“通过激光雷达与毫米波雷达数据检测毫米波反射器的位置计算所述毫米波雷达的坐标系参数,确定毫米波雷达坐标系相对于车辆坐标系的位姿变换关系”的方法包括:
[0027]获取毫米波雷达安装时的α、β、Δz;[0028]根据车辆坐标系计算毫米波雷达的Δx、Δy;
[0029]获取激光雷达及毫米波雷达针对毫米波反射器的激光点云数据和毫米波雷达数据,以从激光点云数和毫米波雷达检测到的毫米波反射器位置重叠为目标,采用梯度下降法求解最优的偏航角γ。[0030]进一步地,所述“比较激光雷达和超声波雷达检测的移动目标的位置差异,确定超声波雷达的位置坐标”的方法包括:[0031]测量超声波雷达安装的位置,根据车辆坐标系计算所述超声波雷达的初始位置坐标;
[0032]设置移动目标,获取激光雷达及超声波雷达针对移动目标的激光点云数据及超声波雷达数据;
[0033]比较激光点云数据及超声波雷达数据的位置差异,确定超声波雷达的位置坐标。
6
CN 112241007 A[0034]
说 明 书
3/10页
作为本发明实施例的再一方面,提供了一种自动驾驶环境感知传感器的布置结
构,包括设置在车辆顶部上方的激光雷达;交错设置在车辆四周的中距毫米波雷达、超声波雷达及360度环视摄像头;设置在车辆前方的长距毫米波雷达,设置在车辆前风挡内容部的前置摄像头,所述激光雷达的线束接头、长距毫米波雷达、前置摄像头与车辆中轴线重合,所述中距毫米波雷达、超声波雷达及360度环视摄像头对称设置。[0035]进一步地,所述布置结构还包括:[0036]设置有一个所述激光雷达,所述激光雷达通过支架安装在车顶,所述激光雷达与车顶设置高度为20-30cm,用于获取车辆周围准确的三维信息;和/或[0037]设置有四个所述中距毫米波雷达,分别设置在车辆前后保险杠的两侧,左右对称布置,位于前保险杠两侧的所述中距毫米波雷达与车辆行驶方向设置为第一夹角,位于后保险杠两侧的所述中距毫米波雷达与车辆行驶方向设置为第二夹角,所述第一夹角大于第二夹角,用于检测车身四周障碍物;和/或[0038]设置有十二个所述超声波雷达,所述超声波雷达包括8个超声波驻车辅助类型雷达和4个自动泊车辅助类型雷达,所述超声波驻车辅助类型雷达分别位于车辆前、后保险杠,用于探测车辆前后障碍物;所述自动泊车辅助类型雷达安装在车辆前、后保险杠四角,呈左右对称布置,用于探测侧方停车空间;和/或[0039]设置有四个所述360度环视摄像头,分别位于车辆前、后保险杠及两侧后视镜,位于车辆前、后保险杠的所述360度环视摄像头设置在车辆中轴线上,设置与保险杠前端,与地面呈第三角度夹角,位于两侧后视镜的所述360度环视摄像头的中轴线与地面呈第四角度夹角;设置在外后视镜下表面;用于感知近距离物体;和/或[0040]设置有一个所述长距毫米波雷达,位于车辆前方的保险杠内,所述长距毫米雷达与保险杠表面距离设置在50-150mm,与地面的距离设置50-80cm,所述长距毫米雷达用于检测前方障碍物;和/或
[0041]设置一个所述前置摄像头与车辆中轴线上,位于车辆的前挡风玻璃的上边缘内侧,用于识别前方路面信息;和/或
[0042]所述布置结构还设置有一个内置摄像头,位于驾驶员对面,用于检测驾驶员疲劳状况。
[0043]进一步地,所述布置结构中的激光雷达、中距毫米波雷达、长距毫米波雷达、超声波雷达、前置摄像头通过上述的自动驾驶环境感知传感器的标定方法进行标定。[0044]作为本发明实施例的又一方面,提供了一种车辆,所述车辆包括上述任意所述的自动驾驶环境感知传感器的布置结构。
[0045]本发明实施例至少实现了如下技术效果:
[0046]本发明实施例提供的自动驾驶环境感知传感器的标定方法,基于对激光雷达的激光点云数据、摄像头的图像数据、毫米波雷达数据、超声波雷达数据的处理,针对不同的传感器采用不同的标定方法,提升了自动驾驶环境感知传感器标定的自动化程度,且精确性高,满足多传感器融合的要求;本发明实施例提供的自动驾驶环境感知传感器的布置结构为基于驾驶的应用场景和感知需求,设计的感知传感器布置方式,在满足车体360度均覆盖的同时,实现一定程度的传感器冗余,当个别传感器出现故障的情况下,可以正常进行周围环境的监测,提升了自动驾驶安全性的,而且,通过本实施例布置方法能够在保证感知性能
7
CN 112241007 A
说 明 书
4/10页
的前提下,实现最大限度的相互配合,尽可能降低传感器数量,有效降低成本。[0047]本发明的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过在所写的说明书、权利要求书、以及附图中所记载的结构来实现和获得。[0048]下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。附图说明
[0049]附图用来提供对本发明的进一步理解,并且构成说明书的一部分,与本发明的实施例一起用于解释本发明,并不构成对本发明的限制。在附图中:
[0050]图1为本发明一实施例的自动驾驶环境感知传感器的标定方法流程图;[0051]图2为本发明一实施例的车辆坐标系示意图;
[0052]图3为本发明一实施例的激光雷达标定方法的流程图;
[0053]图4为本发明一实施例的计算激光雷达坐标系中偏航角方法的流程图;[0054]图5为本发明一实施例的摄像头标定方法的流程图;[0055]图6为本发明一实施例的毫米波雷达标定方法的流程图;[0056]图7为本发明一实施例的超声波雷达标定方法的流程图;
[0057]图8为本发明一实施例的自动驾驶环境感知传感器的布置结构示意图。
具体实施方式
[0058]为详细说明本发明的技术内容、所实现目的及效果,以下结合实施方式并配合附图予以说明。
[0059]附图和以下说明描述了本发明的可选实施方式以教导本领域技术人员如何实施和再现本发明。为了教导本发明技术方案,已简化或省略了一些常规方面。本领域技术人员应该理解源自这些实施方式的变型或替换将落在本发明的保护范围内。本领域技术人员应该理解下述特征能够以各种方式组合以形成本发明的多个变型。由此,本发明并不局限于下述可选实施方式,而仅由权利要求和它们的等同物限定。[0060]实施例1
[0061]本实施例提供了一种自动驾驶环境感知传感器的标定方法,如图1所示,所述标定方法包括:
[0062]S11建立车辆坐标系;
[0063]S12基于激光雷达发送的地面点云数据建立平整地面的平面方程,确定激光雷达坐标系相对于车辆坐标系的位姿变换关系;
[0064]S13匹配同一场景的激光雷达的点云数据及摄像头的图像数据的边缘点,根据摄像头和激光雷达的坐标系变换关系确定所述摄像头坐标系相对于车辆坐标系的位姿变换关系;
[0065]S14通过激光雷达与毫米波雷达数据检测毫米波反射器的位置计算所述毫米波雷达的坐标系参数,确定毫米波雷达坐标系相对于车辆坐标系的位姿变换关系;[0066]S15比较激光雷达和超声波雷达检测的移动目标的位置差异,确定超声波雷达的位置坐标。
8
CN 112241007 A[0067]
说 明 书
5/10页
在本实施例中,首先通过S11建立车辆坐标系,可以根据数据处理的方便,定义一
个合适的坐标系,保证在车辆行驶过程中各传感器在坐标系中的位置和角度不变,一般以车辆后轴中心为原点,如图2所示,车辆中轴线设置为x轴,后轴所在直线设置为y轴,z轴朝上;再由S12、S13、S14、S15将各个传感器的坐标系统一到车辆坐标系下,实现更加方便描述传感器感知的环境信息以及统一处理这些环境信息;通过S12进行激光雷达坐标系的确定,其中的激光雷达可以是32线激光雷达,本步骤可以借助标定物采用自动标定的方法建立激光雷达坐标系相对于车辆坐标系的位姿变换关系,计算的参数包括偏移量Δx、Δy、Δz以及旋转角α(翻滚角)、β(俯仰角)、γ(偏航角);通过S13进行摄像头的标定,例如前置摄像头,以激光雷达为参照,利用激光雷达标定结果,借助标定板(棋盘格、四孔板),通过摄像头和激光雷达的联合标定,求解摄像头坐标系相对于车辆坐标系的位姿变换关系,用于实现激光雷达和视觉数据的融合处理。通过S14进行毫米波雷达标定,其中的毫米波雷达包括长距毫米波雷达和中距毫米波雷达;通过S15利用激光雷达检测的移动目标位置和超声波雷达探测的同一移动目标位置,比较激光点云和超声波探头数据,计算超声波雷达位置。[0068]在本实施例中,基于对自动驾驶的应用和感知范围的分析,提供了感知传感器的自动标定方法,借助自然标定场地和标定工具,对传感器接收的数据中的典型特征进行处理分析,其中自然标定场地中,针对激光雷达的标定场地需要地面平整,针对摄像头的标定场地优选的为周围环境具有较多边缘明显的场景,室外或者亮一点的室内环境均可,场景不能太空旷,不能有树等边缘不明显的参照物。[0069]优选地,在一个实施例中,如图3,所述S12的方法包括:[0070]S21测量激光雷达的初始安装位置,结合车辆坐标系确定x轴、y轴方向的偏移量Δx、Δy;
[0071]S22接收激光雷达发送的地面点云数据,获取地面点云的三维坐标,采用最小二乘法拟合地面的平面方程,建立地面平整度函数为优化目标函数,以翻滚角α、俯仰角β为待优化参数,采用BP神经网络方法求解最优值;
[0072]S23利用平面方程确定相对z轴方向的偏移量Δz;[0073]S24基于深度学习的激光点云目标物识别结果,采用优化算法求解偏航角最优值γ。
[0074]在本实施例中,先获得激光雷达的初始安装位置,其中可以根据车身结构、激光雷达支架设计确定初步安装位置,保证激光雷达的感知范围尽可能大;测量数据的精确性能够更方便Δx、Δy的计算,保证安装时激光雷达的中心在车辆中轴线上,这样Δx=0,到后轴中心的水平距离;通过S22建立平整地面的平面方程,基于非线性优化方法,求解α、β最优值,从而实现标定α、β值,在本步骤中,以水平平整地面为参照,保证车辆两侧的平整地面不小于一定宽度,实现地面水平的的宽度阈值优选为5-10米;其中的平面方程为数学上的平面方程,形式如:ax+by+cz+d=0,建立地面平整度函数为优化目标函数,通过BP神经网络方法求解α、β最优值;S23根据S22最终拟合的平面方程ax+by+cz+d=0,当a=0、b=0时,计算Z轴方向的偏移量;在利用标定物获得激光点云数据,进行深度学习,计算偏航角。[0075]通过本实施例方法通过上述步骤,获得了Δx、Δy、Δz、α、β、γ的相对值,确定了车顶激光雷达相对于车体的准确位姿,实现了对激光雷达的标定,方法简单,精准率高,而且方便操作,自动化程度高。
9
CN 112241007 A[0076]
说 明 书
6/10页
优选地,在一个实施例中,如图4所示,所述S24的方法包括:
[0077]S241在车辆坐标系的x轴上设置标定物,将所述标定物放在在车辆正前方的预设距离内,设置初始偏航角值γ;
[0078]S242接收激光雷达检测标定物的点云数据,根据所述Δx、Δy、Δz、α、β、γ,将点云数据从激光雷达坐标系转换到车辆坐标系下;[0079]S243建立Pointnet深度学习网络,识别点云数据中的标定物,确定标定物的位置,采用梯度下降法求解最优γ。[0080]在本实施例中,S241标定物可以是圆锥形标定物,在激光点云数据中能够精确定位圆锥形标定物的位置,比较容易判断是否在坐标系的轴线上,其他有规则棱角的形状也可以;其中的预设距离可以是5-7米,优选的为6米;通过S242及S243,计算标定物到y=0轴线的距离作为目标函数,以标定物落在y=0的轴线上作为目标,求最优γ,本实施例标定方法简单,自动化程度高,而且数据准确率高。[0081]优选地,在一个实施例中,如图5所示,所述S13的方法包括:[0082]S31利用张正友标定法标定摄像头内参;[0083]S32确定标定场景,获取雷达激光及摄像头在标定场景下针对移动的标定板的点云数据及图像数据;
[0084]S33提取并匹配所述点云数据及图像数据的边缘点;
[0085]S34根据匹配关系求解摄像头坐标系和激光雷达坐标系之间的变换关系。[0086]在本实施例中,S32中的确定的标定场景,选择边缘多的场景,提取更多的边缘信息,就会有更多的数据参与匹配,匹配的准确性更高;其中,边缘比较多的场景主要指周围有棱角物体比较多,如正方体柱子的四角、标定板的四角、标定板之间的圆孔、窗户的四角等,移动标定板的目的也是为了提取更多的边缘信息,增加匹配的数据;通过S33匹配边缘点,确定匹配关系,即从图像中提取n个(n尽可能多)边缘点(正方体柱子的四角点、标定板的四角点等),从点云中找到对应的点,得到n个点对,通过优化计算建立起图像点坐标和点云点坐标的对应关系,其他的非边缘点也能由图像坐标计算出点云坐标;具体的匹配方法可以首先点云重采样,将三维点云转换为二维图像,再利用二维图像的常用匹配方法,如SIFT算法、SURF算法等进行匹配;通过本实施例方法求解摄像头坐标系和激光雷达坐标系之间的变换关系,从而获取摄像头坐标系相对于车辆坐标系的位姿变换关系。[0087]优选地,在一个实施例中,如图6所示,所述S14的方法包括:[0088]S41获取毫米波雷达安装时的α、β、Δz;[0089]S42根据车辆坐标系计算毫米波雷达的Δx、Δy;
[0090]S43获取激光雷达及毫米波雷达针对毫米波反射器的激光点云数据和毫米波雷达数据,以从激光点云数和毫米波雷达检测到的毫米波反射器位置重叠为目标,采用梯度下降法求解最优的偏航角γ。[0091]在本实施例中,通过三种不同方式获得不同的参数,由于毫米波雷达安装时对翻滚角、俯仰角和高度有较高要求,获取安装时参数值的精度能够满足数据处理的要求,例如:通过安装时的离地高度减去车轴半径,可以得到Δz;再根据车辆坐标系通过加减推算毫米波雷达的Δx、Δy;其中Δx为测量毫米波雷达安装位置到车轴的距离;Δy根据车辆前后轴距、前轴到车头距离、毫米波雷达安装位置到车头距离可以计算毫米波雷达到后轴中
10
CN 112241007 A
说 明 书
7/10页
心的水平距离;S43中接收激光点云和毫米波雷达数据,以从激光点云检测到反射器的位置和毫米波雷达检测到的位置重叠为目标,采用梯度下降法求解最优的偏航角。[0092]优选地,在一个实施例中,如图7所示,所述S15的方法包括:[0093]S51测量超声波雷达安装的位置,根据车辆坐标系计算所述超声波雷达的初始位置坐标;
[0094]S52设置移动目标,获取激光雷达及超声波雷达针对移动目标的激光点云数据及超声波雷达数据;
[0095]S53比较激光点云数据及超声波雷达数据的位置差异,确定超声波雷达的位置坐标。
[0096]在本实施例中,通过加减法推算超声波雷达的初始位置坐标,根据超声波雷达安装时的位置、车轴半径、前后轴距等计算超声波探头在车辆坐标系中的坐标。[0097]本实施例可以是在传感器布置和安装之后,进行的传感器标定,确定不同传感器坐标系之间的相互转换关系,保证多传感器之间良好的融合。本实施例借助自然标定场地和标定工具,结合目标识别等技术,通过处理传感器的接收数据,基于对激光点云、图像、毫米波雷达数据、超声波探头数据的处理分析,结合深度学习和目标识别技术,实现准确性和自动化程度高的感知传感器标定,满足多传感器融合的要求,对实现准确和完整的环境感知,保证自动驾驶的安全性,具有重要的意义。[0098]实施例2
[0099]本发明实施例提供了一种自动驾驶环境感知传感器的布置结构,如图8所示,包括设置在车辆顶部上方的激光雷达11;交错设置在车辆四周的中距毫米波雷达12、超声波雷达13及360度环视摄像头14;设置在车辆前方的长距毫米波雷达15,设置在车辆前风挡内容部的前置摄像头16,所述激光雷达11的线束接头、长距毫米波雷达15、前置摄像头16与车辆中轴线重合,所述中距毫米波雷达12、超声波雷达13及360度环视摄像头14对称设置。[0100]本实施例针对特定的自动驾驶应用场景,设计感知传感器的布置方式,根据不同传感器感知范围不同,在保证车体360度均覆盖的同时,保证一定的传感器冗余;由于传感器配置影响感知范围、性能、传感器数量等,从而影响价格,每种传感器的价格不同,本实施例在保证感知性能的前提下,合理配置传感器,最大限度的降低传感器数量,降低成本,实现了在保证自动驾驶安全性的同时,有效降低成本。[0101]优选地,在一个实施例中,所述布置结构还包括:[0102]设置有一个所述激光雷达11,所述激光雷达通过支架安装在车顶,所述激光雷达与车顶设置高度为20-30cm,用于获取车辆周围准确的三维信息。[0103]在本实施例中,激光雷达布置在车辆中轴线上,其本体线束接头与车辆中轴线重合且接头向后;激光雷达本体中轴线与地面基本平行,与路面夹角的最大偏差不超过5°;其中,车顶1个32线激光雷达,通过安装支架安装在车顶,获取最大的感知范围,识别和跟踪障碍物,实现自动驾驶感知系统的冗余,同时获取车辆周围准确的三维信息,确保车辆行驶安全。车顶的支架距离车顶的范围优选的可以25cm。[0104]优选地,在一个实施例中,所述布置结构还包括:[0105]设置有四个所述中距毫米波雷达12,分别设置在车辆前后保险杠的两侧,左右对称布置,位于前保险杠两侧的所述中距毫米波雷达与车辆行驶方向设置为第一夹角,位于
11
CN 112241007 A
说 明 书
8/10页
后保险杠两侧的所述中距毫米波雷达与车辆行驶方向设置为第二夹角,所述第一夹角大于第二夹角,用于检测车身四周障碍物。[0106]在本实施例中,采用隐藏式安装方式,雷达波束的中心平面要求与路面基本平行,与路面夹角的最大偏差不超过5度;其中,第一夹角的范围可以是40-50度,第二夹角的范围为25-35度;优选地,前侧向毫米波雷达与车辆行驶方向成45度夹角;后侧向毫米波雷达与车辆行驶方向成30度夹角;中距毫米波雷达用于监测车辆盲区,检测车身四周障碍物,判断车辆变道和超车条件。[0107]优选地,在一个实施例中,所述布置结构还包括:[0108]设置有十二个所述超声波雷达13,所述超声波雷达包括8个超声波驻车辅助类型雷达和4个自动泊车辅助类型雷达,所述超声波驻车辅助类型雷达分别位于车辆前、后保险杠,用于探测车辆前后障碍物;所述自动泊车辅助类型雷达安装在车辆前、后保险杠四角,呈左右对称布置,用于探测侧方停车空间;[0109]在本实施例中,超声波雷达用于泊车等低速和短距离场景,其中,8个UPA(UltrasonicParkingAssistant,超声波驻车辅助)类型安装在车辆前后保险杠上方,超声波雷达探测面与保险杠表面齐平且法向垂直;探测车辆前后障碍物,4个APA(AutomaticParkingAssistant,自动泊车辅助)类型安装在车身侧面,呈左右对称布置,超声波雷达布置在原车位置上,雷达探测面与保险杠表面齐平且法向垂直,探测侧方停车空间。
[0110]优选地,在一个实施例中,所述布置结构还包括:[0111]设置有四个所述360度环视摄像头14,分别位于车辆前、后保险杠及两侧后视镜,位于车辆前、后保险杠的所述360度环视摄像头设置在车辆中轴线上,设置与保险杠前端,与地面呈第三角度夹角,位于两侧后视镜的所述360度环视摄像头的中轴线与地面呈第四角度夹角;设置在外后视镜下表面;用于感知近距离物体。[0112]在本实施例中,采用内装方式,感知车身四周的车辆、行人等障碍物,辅助判断道路交通拥堵状况,并辅助实现自动泊车功能,不做标定数据。其中,设置在前、后保险杠的360度环视摄像头外漏于保险杠,尽量布置在保险杠最前端;摄像头离地高度至少50cm,第三夹角的范围为5-15度,优选的与地面夹角呈10度,向下;设置在两侧后视镜的360度环视摄像头镜头中轴线与地面夹第四角度夹角范围为25-35度,优选的为30度。[0113]优选地,在一个实施例中,所述布置结构还包括:[0114]设置有一个所述长距毫米波雷达15,位于车辆前方的保险杠内,所述长距毫米雷达与保险杠表面距离设置在50-150mm,与地面的距离设置50-80cm,所述长距毫米雷达用于检测前方障碍物。
[0115]在本实施例中,毫米波雷达需隐藏在保险杠内部;其中雷达波束的中心平面要求与路面基本平行,与路面夹角的最大偏差不超过5°;毫米波雷达优先布置在车辆中轴线上,如无法实现,允许正Y向最大偏置距离为300mm;另外,雷达安装位置保险杠表面必须平滑且厚度均匀,不能出现料厚突变或结构复杂的情况,且不得夹杂有金属和碳纤维;用于检测前方车辆的距离、速度和方向信息,保证自适应巡航和自动紧急制动时,与前方车辆处于安全距离内。
[0116]优选地,在一个实施例中,所述布置结构还包括:
12
CN 112241007 A[0117]
说 明 书
9/10页
设置一个所述前置摄像头16与车辆中轴线上,位于车辆的前挡风玻璃的上边缘内
侧,用于识别前方路面信息。[0118]在本实施例中,前置摄像头也可以同时设置在内后视镜的后方,识别路面车道标线、行人和交通指示标牌,保证车辆在本车道内行驶,以及自动驾驶车辆遵守交通法规的能力;其中,摄像头的安装可以通过粘贴前结合前风挡玻璃倾斜角度确认摄像头角度,根据设计要求进行角度调节;摄像头通过双面胶粘贴在前风挡玻璃内侧,内后视镜支架下端,不得影响驾驶员视野;摄像头线束采用隐藏式布置,隐藏在顶棚内侧。[0119]优选地,在一个实施例中,所述布置结构还包括:[0120]所述布置结构还设置有一个内置摄像头17,位于驾驶员对面,用于检测驾驶员疲劳状况。
[0121]在本实施例中,内置摄像头位于驾驶员对面,可以设置在车辆的前挡风玻璃等位置,通过分析驾驶员面部表情变化,检测驾驶员疲劳状况,可以不做标定处理。[0122]优选地,在一个实施例中,所述布置结构还包括:[0123]所述布置结构中的激光雷达、中距毫米波雷达、长距毫米波雷达、超声波雷达、前置摄像头通过上述的自动驾驶环境感知传感器的标定方法进行标定。[0124]在本实施例中,将一种自动驾驶环境感知传感器的布置结构及一种自动驾驶环境感知传感器的标定方法相结合,将布置结构中的各个传感器的坐标系统一到车辆坐标系下,满足多传感器融合的要求,对实现准确和完整的环境感知,保证自动驾驶的安全性。[0125]上述实施例中,由于激光雷达、前向毫米波雷达、前置摄像头都安装在中轴线上,能最大限地利用三个传感器接收的数据,减少数据处理时间;而且,由于前侧方的两个中距离毫米波雷达的安装角度应使得感知范围覆盖正前方区域,保证正前方行车重点关注区域有更多的冗余信息;另外,通过4个中距毫米波雷达、360度环视摄像头、超声波雷达以车辆中轴线为中心,呈对称分布,减少线束连接距离,缩短通信时间,降低传感器安装工作量。实现了整个传感器布置结构在某个传感器失效的情况下,仍能保证感知系统运行,鲁棒性强,成本低。
[0126]实施例3
[0127]基于同一发明构思,本发明实施例还提供了一种车辆,由于本实施车辆所解决问题的原理与前述实施例的自动驾驶环境感知传感器的布置结构相似,因此本实施例车辆的实施可以参见前述一种自动驾驶环境感知传感器的布置结构的实施例,重复之处不再赘述。
[0128]本发明实施例提供了一种车辆,所述车辆中包括如上述任一项实施例所述的一种自动驾驶环境感知传感器的布置结构。[0129]在本实施例中,提供了一套适用自动驾驶的环境感知传感器配置方案及传感器的自动标定方法,实现一种新的适用于自动驾驶的环境感知传感器布置和标定方案。在本实施车辆中,除激光雷达之外,其他传感器均采用隐藏式的内装方案,适用于L3级自动驾驶量产车辆的整车集成。
[0130]本领域内的技术人员应明白,本发明的实施例可提供为方法、装置、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机
13
CN 112241007 A
说 明 书
10/10页
可用存储介质(包括但不限于磁盘存储器和光学存储器等)上实施的计算机程序产品的形式。
[0131]本发明是参照根据本发明实施例的方法、设备(装置)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。[0132]这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
[0133]这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。[0134]显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
14
CN 112241007 A
说 明 书 附 图
1/4页
图1
图2
15
CN 112241007 A
说 明 书 附 图
2/4页
图3
图4
16
CN 112241007 A
说 明 书 附 图
3/4页
图5
图6
17
CN 112241007 A
说 明 书 附 图
4/4页
图7
图8
18
因篇幅问题不能全部显示,请点此查看更多更全内容