CN107024687A - 一种离线快速实现pos/激光雷达安装误差标定的方法 - Google Patents

一种离线快速实现pos/激光雷达安装误差标定的方法 Download PDF

Info

Publication number
CN107024687A
CN107024687A CN201610069048.7A CN201610069048A CN107024687A CN 107024687 A CN107024687 A CN 107024687A CN 201610069048 A CN201610069048 A CN 201610069048A CN 107024687 A CN107024687 A CN 107024687A
Authority
CN
China
Prior art keywords
building
pos
installation error
wgs
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.)
Granted
Application number
CN201610069048.7A
Other languages
English (en)
Other versions
CN107024687B (zh
Inventor
周东灵
林翰
刘崇亮
徐兴华
扈光锋
刘垒
曲雪云
李文耀
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Automation Control Equipment Institute BACEI
Original Assignee
Beijing Automation Control Equipment Institute BACEI
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Automation Control Equipment Institute BACEI filed Critical Beijing Automation Control Equipment Institute BACEI
Priority to CN201610069048.7A priority Critical patent/CN107024687B/zh
Publication of CN107024687A publication Critical patent/CN107024687A/zh
Application granted granted Critical
Publication of CN107024687B publication Critical patent/CN107024687B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497—Means for monitoring or calibrating

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

本发明属于误差标定领域，具体公开一种离线快速实现POS/激光雷达安装误差标定的方法，包括步骤1：选定合适的标校地物；步骤2：展外场车载试验，采集POS和雷达数据；步骤3：解算安装误差，通过迭代的方法依次解算出三个安装误差角Δγ、Δθ、Δψ，从而实现将三维相对位置坐标精确投影到WGS-84坐标系；通过设计建筑物和试验车的试验场景，实现了理论计算与实地检测的统一，高效准确地实现了离线快速实现POS/激光雷达安装误差标定的方法。

Description

一种离线快速实现POS/激光雷达安装误差标定的方法
技术领域
本发明属于误差标定领域，具体涉及一种离线快速实现POS/激光雷达安装误差标定的方法。
背景技术
POS数据经事后处理可获得WGS-84世界大地坐标系下的高精度位置信息，激光雷达利用激光测距原理可给出目标物体在雷达机体坐标系下的三维位置坐标，根据POS给出的姿态角信息及事先标定出的POS/激光雷达之间的安装误差，即可将激光雷达给出的三维相对位置坐标投影到WGS-84坐标系，从而给出目标物体的点云数据。现有技术中并没有一种高效准确的离线快速实现POS/激光雷达安装误差标定的方法。
发明内容
本发明的目的在于提供一种离线快速实现POS/激光雷达安装误差标定的方法。
实现本发明目的的技术方案：
一种快速实现POS/激光雷达安装误差标定的方法，包括下列步骤：
步骤1：选定合适的标校地物
(1.1)选定测量目标建筑物S，建筑物S的棱边垂直于地面，取棱边的某高端点作为第一特征点A，取棱边的某低端点作为第二特征点B；
(1.2)选定试验场地；在试验场地上设置两条平行线，分别为第一条试验车行车基准线L1、第二条试验车行车基准线L2，两条基准线的间距为L；
步骤2：展外场车载试验，采集POS和雷达数据；
综合POS和雷达数据，获得在第一条试验车行车基准线L1中获得的建筑物S粗略三维位置坐标(X，Y，Z)和在第二条试验车行车基准线L2中获得的建筑物S粗略三维位置坐标(X’，Y’，Z’)；
步骤3：解算安装误差
(3.1)将步骤2获得的建筑物S粗略三维位置坐标(X，Y，Z)投影到WGS-84坐标系下，计算公式如下：
[x y z]T＝C(Δψ,Δθ,Δγ)[X Y Z]T
式中，
Δψ为POS和雷达之间的航向安装误差角，Δθ为俯仰安装误差角，Δγ为滚动安装误差角，三个误差角的初始值均为0；
C为Δψ→Δθ→Δγ获得方向余弦矩阵：
经过解算，分别得到建筑物S在WGS-84坐标系下的点云数据，并形成建筑物S在WGS-84坐标系下的图像；
在建筑物S在WGS-84坐标系下的图像中识别出第一特征点A和第二特征点B，将二者的坐标分别记作A(xA、yA、zA)、B(xB、yB、zB)；
(3.2)标定滚动安装误差角
通过公式
获得滚动安装误差角Δγ；
将Δγ带入步骤(3.1)的公式中，获得更新1次后的建筑物S在WGS-84坐标系下的点云数据和建筑物S在WGS-84坐标系下的图像，再次从图形中识别出A、B，坐标分别记作
(3.2)标定俯仰安装误差角
通过公式
获得俯仰安装误差角Δθ；
将Δγ、Δθ同时带入步骤(3.1)的公式中，建筑物S在WGS-84坐标系下的点云数据和建筑物S在WGS-84坐标系下的图像，再次从图形中识别出A、B，坐标分别记作
(3.3)标定航向安装误差角
对第二条试验车行车基准线L2中获得的建筑物S粗略三维位置坐标(X’，Y’，Z’)及更新后的Δγ、Δθ带入步骤(3.1)的公式中，得到A、B坐标，分别记作
通过公式
获得航向安装误差角Δψ。
本发明的有益技术效果在于：
本发明提供的一种离线快速实现POS/激光雷达安装误差标定的方法通过迭代的方法依次解算出三个安装误差角Δγ、Δθ、Δψ，从而实现将三维相对位置坐标精确投影到WGS-84坐标系；通过设计建筑物和试验车的试验场景，实现了理论计算与实地检测的统一，高效准确地实现了离线快速实现POS/激光雷达安装误差标定的方法。
附图说明
图1为本发明所提供的一种离线快速实现POS/激光雷达安装误差标定的方法的示意图。
图中：S.建筑物、L1.第一条试验车行车基准线、L2.第二条试验车行车基准线、L.两条基准线的间距、A.第一特征点、B.第二特征点。
具体实施方式
下面结合附图和实施例对本发明作进一步详细说明。
本发明提供的一种快速实现POS/激光雷达安装误差标定的方法包括下列步骤：
步骤1：选定合适的标校地物
(1.1)选定测量目标为图1所示的建筑物S，建筑物S的棱边垂直于地面，取棱边的某高端点作为第一特征点A，取棱边的某低端点作为第二特征点B。
(1.2)选定试验场地，试验场地为水平面，试验场地和建筑物S之间无遮挡，建筑物S的棱边垂直于试验场地，试验场地和建筑物S之间的距离小于激光雷达的测距长度。在试验场地上设置两条平行线，分别为第一条试验车行车基准线L1、第二条试验车行车基准线L2，两条基准线的间距为L。
步骤2：展外场车载试验，采集POS和雷达数据。
将POS和激光雷达分别刚性安装于试验车车顶，POS的前向轴方向、雷达的纵轴方向与试验车的前进方向三者同向安装。整个试验过程中POS和激光雷达两者之间没有相对位移。
启动试验车，同时采集、存储POS和雷达数据。试验车首先沿基准线L1朝一个方向直线行驶，到试验场地边缘后，调头，沿基准线L2朝另一个方向直线行驶，至试验场地边缘后，停车断电。
综合POS和雷达数据，获得在第一条试验车行车基准线L1中获得的建筑物S粗略三维位置坐标(X，Y，Z)和在第二条试验车行车基准线L2中获得的建筑物S粗略三维位置坐标(X’，Y’，Z’)。
步骤3：解算安装误差
(3.1)将步骤2获得的建筑物S粗略三维位置坐标(X，Y，Z)投影到WGS-84坐标系下，计算公式如下：
[x y z]T＝C(Δψ,Δθ,Δγ)[X Y Z]T
式中，
Δψ为POS和雷达之间的航向安装误差角，Δθ为俯仰安装误差角，Δγ为滚动安装误差角，三个误差角的初始值均为0。
C为Δψ→Δθ→Δγ获得方向余弦矩阵：
经过解算，分别得到建筑物S在WGS-84坐标系下的点云数据，并形成建筑物S在WGS-84坐标系下的图像。
在建筑物S在WGS-84坐标系下的图像中识别出第一特征点A和第二特征点B，将二者的坐标分别记作A(xA、yA、zA)、B(xB、yB、zB)。
(3.2)标定滚动安装误差角
通过如下公式：
获得滚动安装误差角Δγ。
将Δγ带入步骤(3.1)的公式中，获得更新1次后的建筑物S在WGS-84坐标系下的点云数据和建筑物S在WGS-84坐标系下的图像，再次从图形中识别出A、B，坐标分别记作
(3.2)标定俯仰安装误差角
通过如下公式：
获得俯仰安装误差角Δθ。
将Δγ、Δθ同时带入步骤(3.1)的公式中，建筑物S在WGS-84坐标系下的点云数据和建筑物S在WGS-84坐标系下的图像，再次从图形中识别出A、B，坐标分别记作
(3.3)标定航向安装误差角
对第二条试验车行车基准线L2中获得的建筑物S粗略三维位置坐标(X’，Y’，Z’)及更新后的Δγ、Δθ带入步骤(3.1)的公式中，得到A、B坐标，分别记作
通过如下公式：
获得航向安装误差角Δψ。
至此，实现POS和激光雷达之间三个安装误差角Δγ、Δθ、Δψ的离线快速标定。
上面结合附图和实施例对本发明作了详细说明，但是本发明并不限于上述实施例，在本领域普通技术人员所具备的知识范围内，还可以在不脱离本发明宗旨的前提下作出各种变化。本发明中未作详细描述的内容均可以采用现有技术。

Claims (2)

1.一种快速实现POS/激光雷达安装误差标定的方法，其特征在于：它包括下列步骤：
步骤1：选定合适的标校地物
(1.1)选定测量目标建筑物S，建筑物S的棱边垂直于地面，取棱边的某高端点作为第一特征点A，取棱边的某低端点作为第二特征点B；
(1.2)选定试验场地；在试验场地上设置两条平行线，分别为第一条试验车行车基准线L1、第二条试验车行车基准线L2，两条基准线的间距为L；
步骤2：展外场车载试验，采集POS和雷达数据；
综合POS和雷达数据，获得在第一条试验车行车基准线L1中获得的建筑物S粗略三维位置坐标(X，Y，Z)和在第二条试验车行车基准线L2中获得的建筑物S粗略三维位置坐标(X’，Y’，Z’)；
步骤3：解算安装误差
(3.1)将步骤2获得的建筑物S粗略三维位置坐标(X，Y，Z)投影到WGS-84坐标系下，计算公式如下：
[x y z]T＝C(Δψ,Δθ,Δγ)[X Y Z]T
式中，
Δψ为POS和雷达之间的航向安装误差角，Δθ为俯仰安装误差角，Δγ为滚动安装误差角，三个误差角的初始值均为0；
C为Δψ→Δθ→Δγ获得方向余弦矩阵：
经过解算，分别得到建筑物S在WGS-84坐标系下的点云数据，并形成建筑物S在WGS-84坐标系下的图像；
在建筑物S在WGS-84坐标系下的图像中识别出第一特征点A和第二特征点B，将二者的坐标分别记作A(xA、yA、zA)、B(xB、yB、zB)；
(3.2)标定滚动安装误差角
通过公式
获得滚动安装误差角Δγ；
将Δγ带入步骤(3.1)的公式中，获得更新1次后的建筑物S在WGS-84坐标系下的点云数据和建筑物S在WGS-84坐标系下的图像，再次从图形中识别出A、B，坐标分别记作
(3.2)标定俯仰安装误差角
通过公式
获得俯仰安装误差角Δθ；
将Δγ、Δθ同时带入步骤(3.1)的公式中，建筑物S在WGS-84坐标系下的点云数据和建筑物S在WGS-84坐标系下的图像，再次从图形中识别出A、B，坐标分别记作
(3.3)标定航向安装误差角
对第二条试验车行车基准线L2中获得的建筑物S粗略三维位置坐标(X’，Y’，Z’)及更新后的Δγ、Δθ带入步骤(3.1)的公式中，得到A、B坐标，分别记作
通过公式
获得航向安装误差角Δψ。
2.根据权利要求1所述的一种快速实现POS/激光雷达安装误差标定的方法，其特征在于：所述步骤2包括
将POS和激光雷达分别刚性安装于试验车车顶，POS的前向轴方向、雷达的纵轴方向与试验车的前进方向三者同向安装；整个试验过程中POS和激光雷达两者之间没有相对位移；
启动试验车，同时采集、存储POS和雷达数据；试验车首先沿基准线L1朝一个方向直线行驶，到试验场地边缘后，调头，沿基准线L2朝另一个方向直线行驶，至试验场地边缘后，停车断电。
CN201610069048.7A 2016-02-01 2016-02-01 一种离线快速实现pos/激光雷达安装误差标定的方法 Active CN107024687B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610069048.7A CN107024687B (zh) 2016-02-01 2016-02-01 一种离线快速实现pos/激光雷达安装误差标定的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610069048.7A CN107024687B (zh) 2016-02-01 2016-02-01 一种离线快速实现pos/激光雷达安装误差标定的方法

Publications (2)

Publication Number Publication Date
CN107024687A true CN107024687A (zh) 2017-08-08
CN107024687B CN107024687B (zh) 2020-07-24

Family

ID=59524895

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610069048.7A Active CN107024687B (zh) 2016-02-01 2016-02-01 一种离线快速实现pos/激光雷达安装误差标定的方法

Country Status (1)

Country Link
CN (1) CN107024687B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108919304A (zh) * 2018-03-07 2018-11-30 山东科技大学 一种基于参考平面的移动测量系统中pos误差补偿方法
CN109696663A (zh) * 2019-02-21 2019-04-30 北京大学 一种车载三维激光雷达标定方法和系统
CN109725303A (zh) * 2018-12-04 2019-05-07 北京万集科技股份有限公司 坐标系的修正方法及装置、存储介质
CN109782258A (zh) * 2018-12-26 2019-05-21 北京百度网讯科技有限公司 车辆激光雷达的位置检测方法、装置及存储介质
CN110376570A (zh) * 2018-07-09 2019-10-25 北京京东尚科信息技术有限公司 对扫描仪坐标系与imu坐标系进行标定的方法、系统和设备
WO2020248190A1 (zh) * 2019-06-13 2020-12-17 深圳市速腾聚创科技有限公司 坐标校正方法、装置、计算设备及计算机存储介质
CN113567963A (zh) * 2021-06-25 2021-10-29 北京四维远见信息技术有限公司 一种对激光雷达测量误差进行精密检测的方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101699313A (zh) * 2009-09-30 2010-04-28 北京理工大学 基于摄像机和三维激光雷达的外部参数标定方法及系统
CN103954953A (zh) * 2014-05-16 2014-07-30 武汉大学 一种基于数据驱动的机载激光雷达盲源误差补偿方法
CN104154928A (zh) * 2014-05-26 2014-11-19 北京航天控制仪器研究所 一种适用于惯性平台内置式星敏感器的安装误差标定方法
CN104574406A (zh) * 2015-01-16 2015-04-29 大连理工大学 一种360度全景激光与多个视觉系统间的联合标定方法
CN104820217A (zh) * 2015-04-14 2015-08-05 同济大学 一种多法向平面的多元线阵探测成像激光雷达的检校方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101699313A (zh) * 2009-09-30 2010-04-28 北京理工大学 基于摄像机和三维激光雷达的外部参数标定方法及系统
CN103954953A (zh) * 2014-05-16 2014-07-30 武汉大学 一种基于数据驱动的机载激光雷达盲源误差补偿方法
CN104154928A (zh) * 2014-05-26 2014-11-19 北京航天控制仪器研究所 一种适用于惯性平台内置式星敏感器的安装误差标定方法
CN104574406A (zh) * 2015-01-16 2015-04-29 大连理工大学 一种360度全景激光与多个视觉系统间的联合标定方法
CN104820217A (zh) * 2015-04-14 2015-08-05 同济大学 一种多法向平面的多元线阵探测成像激光雷达的检校方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
程金龙 等: "车载激光雷达外参数的标定方法", 《光电工程》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108919304A (zh) * 2018-03-07 2018-11-30 山东科技大学 一种基于参考平面的移动测量系统中pos误差补偿方法
CN110376570A (zh) * 2018-07-09 2019-10-25 北京京东尚科信息技术有限公司 对扫描仪坐标系与imu坐标系进行标定的方法、系统和设备
CN109725303A (zh) * 2018-12-04 2019-05-07 北京万集科技股份有限公司 坐标系的修正方法及装置、存储介质
CN109725303B (zh) * 2018-12-04 2021-07-02 北京万集科技股份有限公司 坐标系的修正方法及装置、存储介质
CN109782258A (zh) * 2018-12-26 2019-05-21 北京百度网讯科技有限公司 车辆激光雷达的位置检测方法、装置及存储介质
US11086001B2 (en) 2018-12-26 2021-08-10 Beijing Baidu Netcom Science Technology Co., Ltd. Position detecting method, device and storage medium for vehicle ladar
CN109782258B (zh) * 2018-12-26 2022-03-25 阿波罗智能技术(北京)有限公司 车辆激光雷达的位置检测方法、装置及存储介质
US11561295B2 (en) 2018-12-26 2023-01-24 Beijing Baidu Netcom Science Technology Co., Ltd. Position detecting method, device and storage medium for vehicle ladar
CN109696663A (zh) * 2019-02-21 2019-04-30 北京大学 一种车载三维激光雷达标定方法和系统
WO2020248190A1 (zh) * 2019-06-13 2020-12-17 深圳市速腾聚创科技有限公司 坐标校正方法、装置、计算设备及计算机存储介质
CN113567963A (zh) * 2021-06-25 2021-10-29 北京四维远见信息技术有限公司 一种对激光雷达测量误差进行精密检测的方法
CN113567963B (zh) * 2021-06-25 2024-04-12 北京四维远见信息技术有限公司 一种对激光雷达测量误差进行精密检测的方法

Also Published As

Publication number Publication date
CN107024687B (zh) 2020-07-24

Similar Documents

Publication Publication Date Title
CN107024687A (zh) 一种离线快速实现pos/激光雷达安装误差标定的方法
Stöcker et al. Quality assessment of combined IMU/GNSS data for direct georeferencing in the context of UAV-based mapping
CN104181512B (zh) 用于求取车辆的雷达传感器的失准的方法和设备
CN109084782B (zh) 基于摄像头传感器的车道线地图构建方法以及构建系统
CN110031829B (zh) 一种基于单目视觉的目标精准测距方法
CN110596683A (zh) 一种多组激光雷达外参标定系统及其方法
CN108898638A (zh) 一种车载摄像头在线自动标定方法
CN116577760A (zh) 一种外参标定装置
CN110307791B (zh) 基于三维车辆边界框的车辆长度及速度计算方法
CN105511462B (zh) 一种基于视觉的agv导航方法
WO2020073929A1 (zh) 作业台车及其机械臂光学标靶定位装置和定位方法
CN110687521B (zh) 一种车载激光雷达标定的方法
CN104569998B (zh) 基于激光雷达的车辆安全行驶区域的检测方法及装置
CN112904317A (zh) 一种多激光雷达与gnss_ins系统标定方法
CN105203023A (zh) 一种车载三维激光扫描系统安置参数的一站式标定方法
CN103424112A (zh) 一种基于激光平面辅助的运动载体视觉导航方法
CN111796258B (zh) 雷达参数标定场的构建方法、构建装置及可读存储介质
CN113866747B (zh) 一种多激光雷达的标定方法及装置
CN110579754A (zh) 用于确定车辆的激光雷达与车辆其他的传感器的外参数的方法
CN106546262A (zh) 基于平面控制和约束结合的移动测量系统外参数标定方法
CN104422425A (zh) 一种不规则外形物体空间姿态动态测量方法
CN114396894B (zh) 激光测距与单目视觉的管道直线度检测装置及方法
CN105242252A (zh) 基于图像匹配的下降轨聚束sar雷达定位方法
JP2023164553A (ja) 位置推定装置、推定装置、制御方法、プログラム及び記憶媒体
JP6863027B2 (ja) 立体物検出処理装置

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
GR01 Patent grant
GR01 Patent grant