CN109901183A - 一种提高激光雷达全天候测距精度和可靠性的方法 - Google Patents
一种提高激光雷达全天候测距精度和可靠性的方法 Download PDFInfo
- Publication number
- CN109901183A CN109901183A CN201910190515.5A CN201910190515A CN109901183A CN 109901183 A CN109901183 A CN 109901183A CN 201910190515 A CN201910190515 A CN 201910190515A CN 109901183 A CN109901183 A CN 109901183A
- Authority
- CN
- China
- Prior art keywords
- laser radar
- target point
- radar
- millimetre
- coordinate system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 11
- 238000005259 measurement Methods 0.000 title abstract description 3
- 238000001514 detection method Methods 0.000 claims abstract description 15
- 238000009434 installation Methods 0.000 claims description 28
- 239000011159 matrix material Substances 0.000 claims description 14
- 235000013350 formula milk Nutrition 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 5
- 238000013519 translation Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 230000003287 optical effect Effects 0.000 claims 1
- 239000000428 dust Substances 0.000 abstract 1
- 239000000779 smoke Substances 0.000 abstract 1
- 230000007812 deficiency Effects 0.000 description 3
- 230000002411 adverse Effects 0.000 description 2
- 235000019504 cigarettes Nutrition 0.000 description 2
- 239000003595 mist Substances 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 230000005855 radiation Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035515 penetration Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Landscapes
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种提高激光雷达全天候测距精度和可靠性的方法,通过激光雷达与毫米波雷达对目标点进行联合距离探测,利用校准装置对激光雷达和毫米波雷达探测到的目标信息进行计算处理,得到激光雷达与目标点的校准距离,实现校准,确保激光雷达在雨、雪、雾、霾、尘、烟等恶劣环境下也能精确探测目标点的距离,有效提高激光雷达的探测精度和探测数据的可靠性。
Description
技术领域
本发明涉及一种提高激光雷达在全天候条件下测距精度和可靠性的实现方法。
背景技术
激光雷达由于具备快速精确获取目标三维空间信息的能力而被广泛应用于自动驾驶、测绘、制导等领域。随着无人驾驶技术的兴起,激光雷达已成为自动驾驶无人车上的重要传感器和感知手段。
尽管激光雷达具备测距精度高、分辨率高等优点,激光雷达在无人驾驶应用场景中仍然存在感知适应性不足的问题,比如在雨、雪、雾、霾、尘、烟等恶劣环境下,其性能会受到很大影响,无法实现全天候工作;激光雷达也容易受到自然光或热辐射的影响,在自然光强烈或辐射区域时,其性能会急剧下降。此外,当前的无人驾驶***一般配备多颗激光雷达,而多颗激光雷达同时工作存在相互干扰的问题,容易使激光雷达无法区分接收到的回波信号是否属于自己,从而导致错误的测距结果而引发严重的交通事故。因此,提高激光雷达在全天候条件下的测距精度和可靠性对于激光雷达在无人驾驶中的应用是十分重要的。
毫米波雷达作为无人驾驶汽车上常用的一种传感器,与激光雷达相比,具有探测距离远、搜索区域大、穿透力强、成本低等特点,可在全天候、全天时下实现对目标的探测。
由于车载毫米波雷达具有一定的成本优势,激光雷达通过引入毫米波雷达作为辅助探测手段,可以在投入较低成本的前提下,有效提高激光雷达在全天候、全天时条件下的测距精度和可靠性。
发明内容
为了克服现有技术的不足,本发明提供一种提高激光雷达全天候测距精度和可靠性的方法。
本发明解决其技术问题所采用的技术方案是:
一种提高激光雷达全天候测距精度和可靠性的方法,它包括以下步骤:
步骤S1、拟定一个目标点,利用激光雷达和毫米波雷达分别探测目标点的坐标信息。
步骤S2、将激光雷达坐标系下和毫米波雷达坐标系下探测到的目标点的坐标信息同时转换至校准装置所在的坐标系下,所述校准装置分别与所述激光雷达和毫米波雷达电连接,用于对所述激光雷达和毫米波雷达所获取的数据信息进行处理。
步骤S3、将激光雷达和毫米波雷达的坐标信息同时转换至校准装置所在的坐标系下。
步骤S4、所述校准装置根据毫米波雷达探测到的目标点的坐标信息,以及激光雷达和毫米波雷达的坐标信息,通过计算处理,分别得到所述毫米波雷达与目标点两者之间的距离l1、激光雷达与毫米波雷达两者之间的距离l2、激光雷达与目标点两者之间的距离l’以及l1与l2之间的夹角α。
步骤S5、所述校准装置根据得到的l1、l2以及l1与l2之间的夹角α的值,计算得到所述激光雷达与目标点的基准距离l3。
步骤S6、所述校准装置将所述激光雷达与目标点的基准距离l3与激光雷达与目标点两者之间的距离l’进行校准,并输出激光雷达与目标点的最终探测距离l0,校准步骤如下:若l3等于l’,则输出l0=l’;反之,则输出l0=l3。
所述步骤S2中,所述激光雷达和毫米波雷达在探测目标点的坐标信息时均采用二维极坐标系(ρ,θ),其中ρ是目标点的距离信息,θ是目标点的方位角,所述校准装置采用空间直角坐标系(X,Y,Z),二维极坐标系(ρ,θ)到校准装置的空间直角坐标系(X,Y,Z)的变换公式如下:
其中,R是旋转矩阵,t是平移矩阵,O是一行两列的零矩阵,OT是O矩阵的转置,本实施例中,旋转矩阵R和平移矩阵t均可通过(张正友)标定法计算得到。
所述步骤S3中,所述激光雷达和毫米波雷达的坐标信息属于GPS坐标系,所述校准装置所在的坐标系属于空间直角坐标系(X,Y,Z),GPS坐标系到空间直角坐标系(X,Y,Z)的变换公式如下:
其中,N为卯酉圈的半径,a为地球椭球的长半轴;
b为地球椭球的短半轴;
B为大地纬度;
L为大地经度;
H为大地高。
本发明的有益效果是:本发明通过激光雷达与毫米波雷达对目标点进行距离探测,利用校准装置对激光雷达和毫米波雷达的坐标信息以及探测到的目标点的坐标信息进行计算处理,得到激光雷达与目标点的校准距离,并通过该校准距离与激光雷达的探测距离进行比较,实现校准,确保激光雷达在雨、雪、雾、霾、尘、烟等恶劣环境下也能准确探测目标点的距离,有效提高激光雷达的探测精度和探测数据的可靠性。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1是本发明的结构示意图;
图2是本发明的操作流程图。
具体实施方式
参照图1、图2,一种提高激光雷达全天候测距精度和可靠性的方法,它包括以下步骤:
步骤S1、拟定一个目标点,利用激光雷达和毫米波雷达分别探测目标点的坐标信息。
步骤S2、将激光雷达坐标系下和毫米波雷达坐标系下探测到的目标点的坐标信息同时转换至校准装置所在的坐标系下,所述校准装置(电脑主机或单片机)分别与所述激光雷达和毫米波雷达电连接,用于对所述激光雷达和毫米波雷达所获取的数据信息进行处理,以实现激光雷达和毫米波雷达的时空同步,具体地,本实施例中,所述激光雷达和毫米波雷达在探测目标点的坐标信息时均采用二维极坐标系(ρ,θ),其中ρ是目标点的距离信息,θ是目标点的方位角,所述校准装置采用空间直角坐标系(X,Y,Z),二维极坐标系(ρ,θ)到校准装置的空间直角坐标系(X,Y,Z)的变换公式如下:
其中,R是旋转矩阵,t是平移矩阵,O是一行两列的零矩阵,OT是O矩阵的转置。
步骤S3、将激光雷达和毫米波雷达的坐标信息同时转换至校准装置所在的坐标系下,与步骤S2相同,通过实现时空同步,将激光雷达和毫米波雷达的坐标信息转换至校准装置所在的坐标系的坐标信息,方便校准装置进行计算处理,具体地,本实施例中,所述激光雷达和毫米波雷达的坐标信息属于GPS坐标系,所述校准装置所在的坐标系属于空间直角坐标系(X,Y,Z),GPS坐标系到空间直角坐标系(X,Y,Z)的变换公式如下:
其中,N为卯酉圈的半径,a为地球椭球的长半轴;
b为地球椭球的短半轴;
B为大地纬度;
L为大地经度;
H为大地高。
步骤S4、所述校准装置根据毫米波雷达探测到的目标点的坐标信息,以及激光雷达和毫米波雷达的坐标信息,通过计算处理,分别得到所述毫米波雷达与目标点两者之间的距离l1、激光雷达与毫米波雷达两者之间的距离l2、激光雷达与目标点两者之间的距离l’以及l1与l2之间的夹角α。
步骤S5、所述校准装置根据得到的l1、l2以及l1与l2之间的夹角α的值,利用余弦定理,计算得到所述激光雷达与目标点的基准距离l3。
步骤S6、所述校准装置将所述激光雷达与目标点的基准距离l3与激光雷达与目标点两者之间的距离l’进行校准,并输出激光雷达与目标点的最终探测距离l0,校准步骤如下:若l3等于l’,则输出l0=l’;反之,则输出l0=l3。
本发明在激光雷达探测距离的情况下,通过引入毫米波雷达作为辅助探测手段,校准激光雷达的探测结果,从而提高激光雷达在恶劣环境下的测距精度,且本发明的校准算法计算简单,易于实现,可以在投入较低成本的前提下,有效弥补了已有研究中对激光雷达在全天候下测距精度和可靠性研究的不足。
以上的实施方式不能限定本发明创造的保护范围,专业技术领域的人员在不脱离本发明创造整体构思的情况下,所做的均等修饰与变化,均仍属于本发明创造涵盖的范围之内。
Claims (3)
1.一种提高激光雷达全天候测距精度和可靠性的方法,其特征在于,它包括以下步骤:
步骤S1、拟定一个目标点,利用激光雷达和毫米波雷达分别探测目标点的坐标信息;
步骤S2、将激光雷达坐标系下和毫米波雷达坐标系下探测到的目标点的坐标信息同时转换至校准装置所在的坐标系下,所述校准装置分别与所述激光雷达和毫米波雷达电连接,用于对所述激光雷达和毫米波雷达所获取的数据信息进行处理;
步骤S3、将激光雷达和毫米波雷达的坐标信息同时转换至校准装置所在的坐标系下;
步骤S4、所述校准装置根据毫米波雷达探测到的目标点的坐标信息,以及激光雷达和毫米波雷达的坐标信息,通过计算处理,分别得到所述毫米波雷达与目标点两者之间的距离l1、激光雷达与毫米波雷达两者之间的距离l2、激光雷达与目标点两者之间的距离l’以及l1与l2之间的夹角α;
步骤S5、所述校准装置根据得到的l1、l2以及l1与l2之间的夹角α的值,计算得到所述激光雷达与目标点的基准距离l3;
步骤S6、所述校准装置将所述激光雷达与目标点的基准距离l3与激光雷达与目标点两者之间的距离l’进行校准,并输出激光雷达与目标点的最终探测距离l0,校准步骤如下:
若l3等于l’,则输出l0=l’;反之,则输出l0=l3。
2.根据权利要求1所述的提高激光雷达全天候测距精度和可靠性的方法,其特征在于所述步骤S2中,所述激光雷达和毫米波雷达在探测目标点的坐标信息时均采用二维极坐标系(ρ,θ),其中ρ是目标点的距离信息,θ是目标点的方位角,所述校准装置采用空间直角坐标系(X,Y,Z),二维极坐标系(ρ,θ)到校准装置的空间直角坐标系(X,Y,Z)的变换公式如下:
,
其中,R是旋转矩阵,t是平移矩阵,O是一行两列的零矩阵,O T 是O矩阵的转置。
3.根据权利要求1所述的提高激光雷达全天候测距精度和可靠性的方法,其特征在于所述步骤S3中,所述激光雷达和毫米波雷达的坐标信息属于GPS坐标系,所述校准装置所在的坐标系属于空间直角坐标系(X,Y,Z),GPS坐标系到空间直角坐标系(X,Y,Z)的变换公式如下:
,
其中,N为卯酉圈的半径,,,
a为地球椭球的长半轴;
b为地球椭球的短半轴;
B为大地纬度;
L为大地经度;
H为大地高。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910190515.5A CN109901183A (zh) | 2019-03-13 | 2019-03-13 | 一种提高激光雷达全天候测距精度和可靠性的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910190515.5A CN109901183A (zh) | 2019-03-13 | 2019-03-13 | 一种提高激光雷达全天候测距精度和可靠性的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109901183A true CN109901183A (zh) | 2019-06-18 |
Family
ID=66953277
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910190515.5A Pending CN109901183A (zh) | 2019-03-13 | 2019-03-13 | 一种提高激光雷达全天候测距精度和可靠性的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109901183A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111239701A (zh) * | 2020-01-23 | 2020-06-05 | 铁将军汽车电子股份有限公司 | 车载距离探测装置的角度校准方法 |
CN111273270A (zh) * | 2020-03-17 | 2020-06-12 | 北京宸控科技有限公司 | 一种掘进机定位定向方法 |
CN111337912A (zh) * | 2020-05-08 | 2020-06-26 | 湖南华诺星空电子技术有限公司 | 一种基于激光雷达的形变监测雷达校正方法 |
CN111487644A (zh) * | 2020-05-27 | 2020-08-04 | 湖南华诺星空电子技术有限公司 | 一种建筑物形变自动测量***及测量方法 |
CN112180346A (zh) * | 2020-08-20 | 2021-01-05 | 北京工业大学 | 一种激光雷达测距精度环境可靠性检测方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040080449A1 (en) * | 2002-10-25 | 2004-04-29 | Omron Corporation | Radar device for a vehicle |
US20160121889A1 (en) * | 2014-10-29 | 2016-05-05 | Denso Corporation | Travel lane marking recognition system |
CN106291512A (zh) * | 2016-07-29 | 2017-01-04 | 中国科学院光电研究院 | 一种阵列推扫式激光雷达测距非均匀性校正的方法 |
CN106405555A (zh) * | 2016-09-23 | 2017-02-15 | 百度在线网络技术(北京)有限公司 | 用于车载雷达***的障碍物检测方法和装置 |
CN108226883A (zh) * | 2017-11-28 | 2018-06-29 | 深圳市易成自动驾驶技术有限公司 | 测试毫米波雷达性能的方法、装置及计算机可读存储介质 |
CN108490927A (zh) * | 2018-01-24 | 2018-09-04 | 天津大学 | 一种应用于无人驾驶汽车的目标跟踪***及跟踪方法 |
CN108509972A (zh) * | 2018-01-16 | 2018-09-07 | 天津大学 | 一种基于毫米波和激光雷达的障碍物特征提取方法 |
CN108779984A (zh) * | 2016-03-16 | 2018-11-09 | 索尼公司 | 信号处理设备和信号处理方法 |
CN109212532A (zh) * | 2017-07-04 | 2019-01-15 | 百度在线网络技术(北京)有限公司 | 用于检测障碍物的方法和装置 |
CN109212530A (zh) * | 2017-07-04 | 2019-01-15 | 百度在线网络技术(北京)有限公司 | 用于确定障碍物速度的方法和装置 |
-
2019
- 2019-03-13 CN CN201910190515.5A patent/CN109901183A/zh active Pending
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040080449A1 (en) * | 2002-10-25 | 2004-04-29 | Omron Corporation | Radar device for a vehicle |
US20160121889A1 (en) * | 2014-10-29 | 2016-05-05 | Denso Corporation | Travel lane marking recognition system |
CN108779984A (zh) * | 2016-03-16 | 2018-11-09 | 索尼公司 | 信号处理设备和信号处理方法 |
CN106291512A (zh) * | 2016-07-29 | 2017-01-04 | 中国科学院光电研究院 | 一种阵列推扫式激光雷达测距非均匀性校正的方法 |
CN106405555A (zh) * | 2016-09-23 | 2017-02-15 | 百度在线网络技术(北京)有限公司 | 用于车载雷达***的障碍物检测方法和装置 |
CN109212532A (zh) * | 2017-07-04 | 2019-01-15 | 百度在线网络技术(北京)有限公司 | 用于检测障碍物的方法和装置 |
CN109212530A (zh) * | 2017-07-04 | 2019-01-15 | 百度在线网络技术(北京)有限公司 | 用于确定障碍物速度的方法和装置 |
CN108226883A (zh) * | 2017-11-28 | 2018-06-29 | 深圳市易成自动驾驶技术有限公司 | 测试毫米波雷达性能的方法、装置及计算机可读存储介质 |
CN108509972A (zh) * | 2018-01-16 | 2018-09-07 | 天津大学 | 一种基于毫米波和激光雷达的障碍物特征提取方法 |
CN108490927A (zh) * | 2018-01-24 | 2018-09-04 | 天津大学 | 一种应用于无人驾驶汽车的目标跟踪***及跟踪方法 |
Non-Patent Citations (1)
Title |
---|
徐爱功等, 中国矿业大学出版社 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111239701A (zh) * | 2020-01-23 | 2020-06-05 | 铁将军汽车电子股份有限公司 | 车载距离探测装置的角度校准方法 |
CN111239701B (zh) * | 2020-01-23 | 2023-12-22 | 铁将军汽车电子股份有限公司 | 车载距离探测装置的角度校准方法 |
CN111273270A (zh) * | 2020-03-17 | 2020-06-12 | 北京宸控科技有限公司 | 一种掘进机定位定向方法 |
CN111337912A (zh) * | 2020-05-08 | 2020-06-26 | 湖南华诺星空电子技术有限公司 | 一种基于激光雷达的形变监测雷达校正方法 |
CN111487644A (zh) * | 2020-05-27 | 2020-08-04 | 湖南华诺星空电子技术有限公司 | 一种建筑物形变自动测量***及测量方法 |
CN112180346A (zh) * | 2020-08-20 | 2021-01-05 | 北京工业大学 | 一种激光雷达测距精度环境可靠性检测方法 |
CN112180346B (zh) * | 2020-08-20 | 2024-03-22 | 北京工业大学 | 一种激光雷达测距精度环境可靠性检测方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109901183A (zh) | 一种提高激光雷达全天候测距精度和可靠性的方法 | |
CN106525025B (zh) | 一种变电站巡检机器人路线规划导航方法 | |
CN108868268B (zh) | 基于点到面距离和互相关熵配准的无人车位姿估计方法 | |
CN108196260A (zh) | 无人驾驶车辆多传感器融合***的测试方法和装置 | |
CN106651990A (zh) | 一种室内地图构建方法及基于室内地图的室内定位方法 | |
CN103472503A (zh) | 探空仪及基于ins的高空风探测方法 | |
CN114994684A (zh) | 多雷达数据融合的扬尘场景下障碍物检测方法与*** | |
CN102998689B (zh) | 基于虚拟传感器的区域判断方法 | |
CN105301621B (zh) | 一种车辆定位装置及一种智能驾考*** | |
CN108548520A (zh) | 一种基于nb-iot的天线姿态远程数据采集*** | |
CN113093254A (zh) | 基于多传感器融合的地图特征的高架桥中的车辆定位方法 | |
CN112130124B (zh) | 一种民航机场内无人机管控设备快速标校与误差处理方法 | |
CN110045328A (zh) | 基于小型无人机平台的反黑飞无人机探测定位方法 | |
CN113608186B (zh) | 一种雷达***与光电成像***的标校方法 | |
CN113296120B (zh) | 一种障碍物检测方法及终端 | |
CN105547282A (zh) | 一种用于移动定位目标的方法及测量设备 | |
CN114252859A (zh) | 目标区域的确定方法、装置、计算机设备和存储介质 | |
CN114252883A (zh) | 目标检测方法、装置、计算机设备和介质 | |
CN114379778B (zh) | 一种利用无人机检测电力杆塔塔顶偏移距离的***和方法 | |
CN115166722B (zh) | 用于路侧单元的无盲区单杆多传感器检测装置及控制方法 | |
CN115877334A (zh) | 一种基于轨迹点的路侧毫米波雷达安装角度标定方法 | |
CN114755645A (zh) | 一种用于高速公路隧道内激光雷达与毫米波雷达的数据标定方法 | |
CN113763457B (zh) | 落差地形的标定方法、装置、电子设备和存储介质 | |
Jingjing et al. | Research on autonomous positioning method of UAV based on binocular vision | |
CN110455184B (zh) | 快速时空定位测姿的光电***方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190618 |
|
RJ01 | Rejection of invention patent application after publication |