一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法技术

本发明专利技术涉及一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法，通过路侧激光雷达、毫米波雷达获取道路上的所有目标，得到待处理的点集数据；将激光雷达的三维点云投影到二维平面中，结合毫米波雷达的二维点集数据进行单应性变换，将二者矩阵投影到同一个平面上，完成激光雷达和毫米波雷达的标定。本发明专利技术以路侧激光雷达和毫米波雷达点数据为基础，通过二维转换和单应性变换，根据高速公路隧道中检测目标的特殊事件点对，将目标特征点对投影到同一个平面上，达到激光雷达和毫米波雷达的标定目的，以提高高速公路隧道目标检测准确率。率。率。

A data calibration method for laser radar and millimeter wave radar in highway tunnel

【技术实现步骤摘要】
一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法


[0001]本专利技术涉及一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法，属于信息工程及控制


技术介绍

[0002]高速公路隧道一直是制约智慧交通的关键节点，多样的雷达传感器对智慧交通的发展带来了新的解决方案。较为常用的为激光雷达和毫米波雷达，两种雷达各有长短。
[0003]从探测精度上来讲，激光雷达具有探测精度高、探测范围广及稳定性强等优点，在精确度方面，毫米波雷达的探测距离受到频段损耗的直接制约，并且对周边所有障碍物无法进行精准的建模。相反激光雷达从抗干扰能力上来讲，由于激光雷达通过发射光束进行探测，受环境影响较大，光束受遮挡后就不能正常使用，因此无法在雨雪雾霾天，沙尘暴等恶劣天气中开启，且探测范围较近。而毫米波导引头穿透雾、烟、灰尘的能力强，因此可以在特殊环境中探测，在这一点上毫米波雷达更胜一筹。
[0004]高速公路隧道作为一个封闭环境，隧道内无GPS信号，且噪声等干扰因素较多，单一的激光雷达或毫米波雷达位置无法实现有效标定。为确保高速公路隧道车路协同的有效实施，本方案考虑采用激光雷达和毫米波雷达联合标定的方法，结合两种传感器的优势，通过激光雷达和毫米波雷达的交叉安装，提高探测精度，扩大探测范围，提升探测准确率，准确标定激光雷达和毫米波雷达位置，为高速公路隧道安全行驶奠定准确的数据基础。
[0005]中国专利文件CN111796248B提供了一种激光雷达和毫米波雷达的联合标定方法，包括以下步骤：在所述毫米波雷达和激光雷达共同感知区域内，设置可沿垂直方向移动的角反射器；所述激光雷达输出相应线束的点云信息，根据所述角反射器的前后空间位置关系，得到角反射器的顶点在激光雷达坐标系中角的空间坐标，根据所述毫米波雷达输出的原始点云信息，得到所述角反射器的顶点在毫米波雷达坐标系中的空间坐标；移动所述角反射器，得到所述角反射器在不同位置时的多组标定数据；根据所述标定数据找到激光雷达坐标系与毫米波雷达坐标系的对应关系。但是高速公路隧道内没有无线信号，无法应用该方法进行GPS标定。

技术实现思路

[0006]针对现有技术的不足，本专利技术提供一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法，将激光雷达的三维点云转化为二维点集，同时对二者数据进行单应性变换，将两个矩阵投影到同一个平面内。依据隧道特殊事件共性点对，对激光雷达和毫米波雷达进行联合标定。
[0007]术语解释：
[0008]点对：同一个点在激光雷达和毫米波雷达中检测到的坐标不同，将同一个点在两个坐标体系中的对应关系称为点对。
[0009]本专利技术的技术方案如下：
[0010]一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法，具体步骤如下：
[0011](1)高速公路隧道路侧分别安装等高的激光雷达和毫米波雷达；
[0012](2)通过路侧激光雷达获取高速公路隧道的车辆数据，得到待处理的三维点云数据，通过路侧的毫米波雷达获取高速公路隧道的车辆数据，得到待处理的平面点集数据；
[0013](3)以激光雷达垂向地面点为原点，搭建三维空间坐标系(如图1)；
[0014](4)将激光雷达的三维点云数据转换为二维数据，假定不在平面上的三维空间点坐标为(x0，y0，z0)，其在平面上的投影点坐标为(x
p
，y
p
，z
p
)，因为投影点到当前点与平面垂直，因此
[0015][0016][0017]推到得到：
[0018][0019][0020][0021]得到三维空间点在不同坐标平面的二维坐标，实现三维点云的平面映射，上式中A、B、C、D为常数；
[0022](5)根据步骤(4)的三维坐标转换公式，在高速公路隧道内，假定毫米波雷达检测的目标坐标数据为(x
r
，y
r
)，激光雷达检测的目标坐标为(x0，y0，z0)，投影到xoy二维平面内的目标坐标为(x
p
，y
p
)，毫米波雷达和激光雷达检测到的目标全部在二维平面内；
[0023](6)根据单应性变换原理，将激光雷达投射后的二维点集与毫米波雷达的二维点集进行单应性变换，投影到同一个平面；
[0024](7)依据激光雷达和毫米波雷达的工作原理，假定毫米波雷达检测点对为激光雷达点云的第一个接触点。在x1Oy1坐标系中，通过高速公路隧道车辆变道的特殊事件，事件的起始点对和结束点对分别重合，为后续激光雷达和毫米波雷达标定确定参考目标；
[0025]通过高速公路隧道车辆变道或不同位置的不同车辆进行激光雷达和毫米波雷达的标定。
[0026]优选的，步骤(1)中，高速公路隧道对侧分别安装等高的激光雷达和毫米波雷达，激光雷达和毫米波雷达沿道路方向的安装间隔为75米，激光雷达在R≤50M，采集数据有效；毫米波雷达在R≤150M，采集数据有效，为有效补充激光雷达数据，提高高速公路目标检测准确率，毫米波雷达检测范围要全面覆盖激光雷达检测范围(如图2)，以提高检测准确；实际工程应用中，毫米波雷达的检测范围可覆盖部分激光雷达检测范围，在提高检测精度的
同时，降低设备布设密度，从而减低成本。
[0027]优选的，步骤(6)中，单应性变换过程为，检测目标在激光雷达二维坐标系x
p
，y
p
和毫米波雷达二维坐标系x
r
，y
r
之间的映射关系如下：
[0028][0029]其中，H为激光雷达平面与毫米波雷达平面之间的单应性矩阵，代表两个平面之间的转换关系，为一个3
×
3的矩阵，s为常数，推得：
[0030][0031]展开得到
[0032][0033]上式中，h
11
、h
12
、h
13
、h
21
、h
22
、h
23
、h
31
、h
32
、h
33
为激光雷达平面与毫米波雷达平面之间的单应性矩阵常数；
[0034]将毫米波雷达数据和激光雷达数据转换至一个坐标系x1Oy1，以便数据进行标定。
[0035]优选的，步骤(7)中，通过高速公路隧道车辆变道进行标定的过程为：
[0036]以检测目标变道事件起始点和结束点为参考，通过激光雷达测量变道事件起始点和结束点与激光雷达的距离L1、L2，分别以起始点和结束点为中心，形成半径为L1、L2的圆，两圆交点标定为激光雷达；同理标定毫米波雷达。
[0037]优选的，步骤(7)中，通过高速公路隧道不同位置的不同车辆进行标定的过程为：
[0038]以高速公路隧道不同车辆不同位置的点为参考，通过激光雷达测定不同位置不同车辆的检测目标与激光雷达的距离L3、L4，分别以不同位置的不同车辆为中心，本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法，其特征在于，具体步骤如下：(1)高速公路隧道路侧分别安装等高的激光雷达和毫米波雷达；(2)通过路侧激光雷达获取高速公路隧道的车辆数据，得到待处理的三维点云数据，通过路侧的毫米波雷达获取高速公路隧道的车辆数据，得到待处理的平面点集数据；(3)以激光雷达垂向地面点为原点，搭建三维空间坐标系；(4)将激光雷达的三维点云数据转换为二维数据，假定不在平面上的三维空间点坐标为(x0，y0，z0)，其在平面上的投影点坐标为(x
p
，y
p
，z
p
)，得到：)，得到：)，得到：得到三维空间点在不同坐标平面的二维坐标，实现三维点云的平面映射，上式中A、B、C、D为常数；(5)根据步骤(4)的三维坐标转换公式，在高速公路隧道内，假定毫米波雷达检测的目标坐标数据为(x
r
，y
r
)，激光雷达检测的目标坐标为(x0，y0，z0)，投影到xoy二维平面内的目标坐标为(x
p
，y
p
)，毫米波雷达和激光雷达检测到的目标全部在二维平面内；(6)根据单应性变换原理，将激光雷达投射后的二维点集与毫米波雷达的二维点集进行单应性变换，投影到同一个平面；(7)通过高速公路隧道车辆变道或不同位置的不同车辆进行激光雷达和毫米波雷达的标定。2.如权利要求1所述的用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法，其特征在于，步骤(1)中，高速公路隧道对侧分别安装等高的激光雷达和毫米波雷达，激光雷达和毫米波雷达沿道路方向的安装间隔为75米。3.如权利要求1所述的用于高速公...

【专利技术属性】
技术研发人员：周勇，左志武，王川，栗剑，陆由付，李涛，吴建清，杨梓梁，徐加宾，庄培芝，蒋庆，田源，刘群，庄绪彩，刘轶鹏，郭铭鑫，
申请(专利权)人：山东大学，
类型：发明
国别省市：