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
pos
building
coordinate
error angle
instruction carriage
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
CN108845343B (zh) 一种基于视觉、gps与高精度地图融合的车辆定位方法
CN106289327B (zh) 一种差分移动机器人里程计标定方法
CN103257342B (zh) 三维激光传感器与二维激光传感器的联合标定方法
CN106441275A (zh) 一种机器人规划路径的更新方法及装置
DE102012014397B4 (de) Verfahren zum Ermitteln einer Position eines Fahrzeugs und Fahrzeug
CN106546262B (zh) 基于平面控制和约束结合的移动测量系统外参数标定方法
CN105588563A (zh) 一种自动驾驶中双目相机与惯性导航单元联合标定方法
CN107044852B (zh) 不平整状态下全站仪测量方法
CN109491384B (zh) 一种道路划线数据的获取方法及装置
CN104200086A (zh) 宽基线可见光相机位姿估计方法
CN103729837A (zh) 一种单个路况摄像机的快速标定方法
CN110488838B (zh) 一种室内自主导航机器人精确重复定位方法
CN103697883B (zh) 一种基于天际线成像的飞行器水平姿态确定方法
CN107144278B (zh) 一种基于多源特征的着陆器视觉导航方法
CN110411375B (zh) 一种基于被动式毫米波/太赫兹成像技术的三维成像方法
CN113819905A (zh) 一种基于多传感器融合的里程计方法及装置
CN104422425A (zh) 一种不规则外形物体空间姿态动态测量方法
CN113255162B (zh) 基于非刚性概率模型的车载激光点云自动误差纠正方法
CN105043392A (zh) 一种飞行器位姿确定方法及装置
US11981362B2 (en) Method and measuring vehicle for determining an actual position of a track
CN110706286A (zh) 一种基于地面标识格的车辆定位方法、定位系统及车辆
JP2023164553A (ja) 位置推定装置、推定装置、制御方法、プログラム及び記憶媒体
CN106595600B (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
GR01 Patent grant
GR01 Patent grant