CN110940358A - 一种激光雷达和惯导联合标定的装置及标定方法 - Google Patents
一种激光雷达和惯导联合标定的装置及标定方法 Download PDFInfo
- Publication number
- CN110940358A CN110940358A CN201911402586.3A CN201911402586A CN110940358A CN 110940358 A CN110940358 A CN 110940358A CN 201911402586 A CN201911402586 A CN 201911402586A CN 110940358 A CN110940358 A CN 110940358A
- Authority
- CN
- China
- Prior art keywords
- hydraulic cylinder
- inertial navigation
- tray
- calibration
- laser radar
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种激光雷达和惯导联合标定的装置及标定方法,所述激光雷达和惯导联合标定的装置,其包括托盘、液压缸Ⅰ、液压缸Ⅱ;所述的托盘下端的四个角各垂直连接一个液压缸Ⅰ;所述的托盘下端中部通过万向头连接液压缸Ⅱ。所述激光雷达和惯导联合标定的标定方法通过上述装置使车辆在各个维度上都能有较大变化,并记录惯导位姿数据,然后通过激光雷达点云匹配算法获得获得激光雷达的帧间位姿,最后通过非线性优化求解标定结果,获得精确的激光雷达和惯导的外参,进而提高激光雷达和惯性导航的联合标定的标定精度。
Description
技术领域
本发明属于监控技术领域,具体涉及一种激光雷达和惯导联合标定的装置及标定方法。
背景技术
多传感器标定是自动驾驶以及机器人领域的一项重要技术,激光雷达和惯性导航的联合标定一直是一个重点,激光雷达的运动补偿,高精度地图的创建都需要准确的二者之间的标定参数。传统的标定方法通常通过驾驶车辆绕八字行驶,并同时记录惯导及激光雷达数据,并利用激光雷达里程计技术获得帧间位姿,对比相同时刻间的惯导的位姿变化,通过手眼标定法可获得二者之间的相对位姿,即外参。
但是通常的绕8字行驶使得车辆并不会在roll、pitch角度上有较大变化,而不论是惯导测量的位姿还是激光雷达点云匹配得到的位姿都会存在一定噪声,如果roll、pitch角变化不大的话,噪声的影响将会过大使标定失效,不能标定二者之间的roll、pitch角。
发明内容
本发明的目的在于针对现有技术的不足,提出一种能使车辆在各个维度上都有较大变化的激光雷达和惯导联合标定的装置,同时提出一种激光雷达和惯导联合标定的标定方法,该标定方法可以精确标定激光雷达和惯导的外参,提高标定精度。
为了实现上述目的,本发明采用了以下技术方案:
一种激光雷达和惯导联合标定的装置,其包括托盘、液压缸Ⅰ、液压缸Ⅱ;所述的托盘下端的四个角各垂直连接一个液压缸Ⅰ;所述的托盘下端中部通过万向头连接液压缸Ⅱ。
进一步的,所述液压缸Ⅰ和托盘通过弹簧或橡胶垫连接。液压缸Ⅰ和托盘之间连接的弹簧或橡胶垫可以保证升降过程中托盘不受剧烈震动。
进一步的,所述激光雷达和惯导联合标定的装置还包括控制系统,所述控制系统包括依次连接的输入模块、中央处理器、输出模块,所述输出模块分别与液压缸Ⅰ和液压缸Ⅱ连接;所述输入模块用于设定托盘的目标姿态,所述中央处理器用于计算液压缸Ⅰ和液压缸Ⅱ的升降量和升降速度,所述输出模块用于控制液压缸Ⅰ和液压缸Ⅱ的升降。
一种激光雷达和惯导联合标定的标定方法,其包括以下步骤:
1)托盘姿态调节:将上述激光雷达和惯导联合标定的装置的液压缸Ⅰ和液压缸Ⅱ水平固定在地面上,然后将车辆固定在托盘上,接着根据设定的托盘目标姿态,计算出液压缸Ⅰ和液压缸Ⅱ的升降量和升降速度,然后调节液压缸Ⅰ和液压缸Ⅱ升降至设定的位置,使托盘到达指定姿态;
2)采集数据:当托盘到达指定姿态稳定后,分别记录惯导位姿数据以及原始激光点云数据;
3)重复步骤:按顺序重复上述步骤至少10次,每次设定不同的托盘目标姿态,并且获得相对应的惯导位姿数据和原始激光点云数据;
4)位姿解算:完成数据采集后,通过惯导直接输出姿态角,再根据姿态角得到每个托盘目标姿态的旋转矩阵,然后通过不同的旋转矩阵获得不同托盘目标姿态的惯导位姿数据之间的相对位姿δRI;不同托盘目标姿态的原始激光点云数据之间的相对位姿δRL采用点云匹配算法获得,所述点云匹配算法为点到线、点到面、GICP中任意一种点云匹配算法;
5)求解标定结果:得到δRI和δRL之后,利用手眼标定算法计算得到相机和惯导的相对位姿X。
进一步的,所述液压缸Ⅰ的顶部在升降过程中任意时刻都处于同一平面。液压缸Ⅰ的顶部任意时刻都在同一平面,减小支架对托盘的拉拽,提高系统稳定性。
进一步的,所述激光雷达和惯导联合标定的标定方法的标定场景是在室内。为保证激光点云能够正确完成前后帧的帧间点云匹配,标定需要在线面特征丰富的场景下进行,这些特征包括杆状物,墙面,地面等规则形状,本发明将标定场景限制在室内,是因为室内平整的墙壁和墙沿以及地面是很好的匹配特征,且易验证匹配效果。
上述手眼标定算法是按照以下公式计算的:
设传感器I和传感器L固连在一起,其相对旋转关系为RIL,假设在t1,t2,t3时刻三者的位姿分别为RWI1,RWI2,RWI3;;RWL1,RWL2,RWL3;在任意时刻传感器I和L的旋转变换关系为:
RWL = RWI ×RIL (1)
则t1,t2时刻的激光雷达相对位姿可以表示为:
δRL12 = RWL1 -1×RWL2 (2)
将测量数据和(1)代入可得:
RIL -1×RWI1 -1×RWI2×RIL = RWL1 -1×RWL2 (3)
令RWI1 -1×RWI2为A矩阵,RWL1 -1×RWL2 为B矩阵,RIL为X矩阵,则上式转换为:
X-1×A×X = B (4)
A×X = X×B(5)
通过(5)式可构建一个关于X的约束,t2,t3时刻同理可得一个类似(5)式的约束,通过利用多帧数据间的相对位姿建立多个约束,(5)式可通过非线性优化求解,优化的目标函数为||A×X - X×B||f,下标f表示Frobenius 范式;由于重点在于旋转角度的标定,所以上述公式不包含外参中的平移项。
与现有技术相比较,本发明具备的有益效果:
1.目前标定方法不能精确标定激光雷达和惯导外参的主要原因在于传统的绕8字数据采集过程中没有充分的roll和pitch维度的运动,而本发明所述的激光雷达和惯导联合标定的装置在托盘的四角和中部安装液压缸,通过液压缸上下伸缩,提供充分的roll和pitch维度的运动,从而获得较大的位姿变化,避免受到噪声的影响而使标定失效。
2.本发明通过激光雷达和惯导联合标定的装置使车辆在各个维度上都能有较大变化,并记录惯导位姿数据,然后通过激光雷达点云匹配算法获得获得激光雷达的帧间位姿,最后通过非线性优化求解标定结果,获得精确的激光雷达和惯导的外参,进而提高激光雷达和惯性导航的联合标定的标定精度。
3.本发明主要标定场景在室内,能够增加点云匹配精度与成功率,提高标定精度。
4.本发明结构简单,实用方便。
附图说明
图1为本发明所述激光雷达和惯导联合标定的装置的立体结构示意图。
图2为本发明所述激光雷达和惯导联合标定的装置得到的俯视结构示意图。
图3为本发明所述激光雷达和惯导联合标定的标定方法的流程图。
附图标记:1-托盘Ⅰ,2-液压缸Ⅰ,21-弹簧,3-液压缸Ⅱ,31-万向头。
具体实施方式
下面结合附图对本发明进一步说明。
实施例1:
如图1~2所示,一种激光雷达和惯导联合标定的装置,其包括托盘1、液压缸Ⅰ2、液压缸Ⅱ3;所述的托盘1下端的四个角各垂直连接一个液压缸Ⅰ2;所述的托盘1下端中部通过万向头31连接液压缸Ⅱ3;所述液压缸Ⅰ2和托盘1通过弹簧21连接;所述激光雷达和惯导联合标定的装置还包括控制系统,所述控制系统包括依次连接的输入模块、中央处理器、输出模块,所述输出模块分别与液压缸Ⅰ2和液压缸Ⅱ3连接;所述输入模块用于设定托盘的目标姿态,所述中央处理器用于计算液压缸Ⅰ2和液压缸Ⅱ3的升降量和升降速度,所述输出模块用于控制液压缸Ⅰ2和液压缸Ⅱ3的升降。
本实施例所述的激光雷达和惯导联合标定的标定方法,其其包括以下步骤:
1)托盘姿态调节:将上述的激光雷达和惯导联合标定的装置的液压缸Ⅰ2和液压缸Ⅱ3水平固定在地面上,然后将车辆固定在托盘1上,接着根据设定的托盘目标姿态,计算出液压缸Ⅰ2和液压缸Ⅱ3的升降量和升降速度,然后调节液压缸Ⅰ2和液压缸Ⅱ3升降至设定的位置,使托盘1到达指定姿态;所述液压缸Ⅰ2的顶部在升降过程中任意时刻都处于同一平面;所述激光雷达和惯导联合标定的标定方法的标定场景是在室内;
2)采集数据:当托盘1到达指定姿态稳定后,分别记录惯导位姿数据以及原始激光点云数据;
3)重复步骤:按顺序重复上述步骤至少10次,每次设定不同的托盘目标姿态,并且获得相对应的惯导位姿数据和原始激光点云数据;
4)位姿解算:完成数据采集后,通过惯导直接输出姿态角,再根据姿态角得到每个托盘目标姿态的旋转矩阵,然后通过不同的旋转矩阵获得不同托盘目标姿态的惯导位姿数据之间的相对位姿δRI;不同托盘目标姿态的原始激光点云数据之间的相对位姿δRL采用点云匹配算法获得,所述点云匹配算法为点到线、点到面、GICP中任意一种点云匹配算法;
5)求解标定结果:得到δRI和δRL之后,利用手眼标定算法计算得到相机和惯导的相对位姿X。
实施例2:
本实施例所述的激光雷达和惯导联合标定的装置与实施例1的区别在于:所述液压缸Ⅰ2和托盘1通过橡胶垫连接;所述的激光雷达和惯导联合标定的标定方法与实施例1所述的标定方法相同。
本文中所描述的具体实施例仅仅是对本发明精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。
Claims (6)
1.一种激光雷达和惯导联合标定的装置,其特征在于:包括托盘(1)、液压缸Ⅰ(2)、液压缸Ⅱ(3);所述的托盘(1)下端的四个角各垂直连接一个液压缸Ⅰ(2);所述的托盘(1)下端中部通过万向头(31)连接液压缸Ⅱ(3)。
2.根据权利要求1所述一种激光雷达和惯导联合标定的装置,其特征在于:所述液压缸Ⅰ(2)和托盘(1)通过弹簧(21)或橡胶垫连接。
3.根据权利要求1所述一种激光雷达和惯导联合标定的装置,其特征在于:所述激光雷达和惯导联合标定的装置还包括控制系统,所述控制系统包括依次连接的输入模块、中央处理器、输出模块,所述输出模块分别与液压缸Ⅰ(2)和液压缸Ⅱ(3)连接;所述输入模块用于设定托盘的目标姿态,所述中央处理器用于计算液压缸Ⅰ(2)和液压缸Ⅱ(3)的升降量和升降速度,所述输出模块用于控制液压缸Ⅰ(2)和液压缸Ⅱ(3)的升降。
4.一种激光雷达和惯导联合标定的标定方法,其特征在于:其包括以下步骤:
1)托盘姿态调节:将如权利要求1~3所述的激光雷达和惯导联合标定的装置的液压缸Ⅰ(2)和液压缸Ⅱ(3)水平固定在地面上,然后将车辆固定在托盘(1)上,接着根据设定的托盘目标姿态,计算出液压缸Ⅰ(2)和液压缸Ⅱ(3)的升降量和升降速度,然后调节液压缸Ⅰ(2)和液压缸Ⅱ(3)升降至设定的位置,使托盘(1)到达指定姿态;
2)采集数据:当托盘(1)到达指定姿态稳定后,分别记录惯导位姿数据以及原始激光点云数据;
3)重复步骤:按顺序重复上述步骤至少10次,每次设定不同的托盘目标姿态,并且获得相对应的惯导位姿数据和原始激光点云数据;
4)位姿解算:完成数据采集后,通过惯导直接输出姿态角,再根据姿态角得到每个托盘目标姿态的旋转矩阵,然后通过不同的旋转矩阵获得不同托盘目标姿态的惯导位姿数据之间的相对位姿δRI;不同托盘目标姿态的原始激光点云数据之间的相对位姿δRL采用点云匹配算法获得,所述点云匹配算法为点到线、点到面、GICP中任意一种点云匹配算法;
5)求解标定结果:得到δRI和δRL之后,利用手眼标定算法计算得到相机和惯导的相对位姿X。
5.根据权利要求4所述的激光雷达和惯导联合标定的标定方法,其特征在于:所述液压缸Ⅰ(2)的顶部在升降过程中任意时刻都处于同一平面。
6.根据权利要求4所述的激光雷达和惯导联合标定的标定方法,其特征在于:所述激光雷达和惯导联合标定的标定方法的标定场景是在室内。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911402586.3A CN110940358B (zh) | 2019-12-31 | 2019-12-31 | 一种激光雷达和惯导联合标定的装置及标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911402586.3A CN110940358B (zh) | 2019-12-31 | 2019-12-31 | 一种激光雷达和惯导联合标定的装置及标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110940358A true CN110940358A (zh) | 2020-03-31 |
CN110940358B CN110940358B (zh) | 2023-07-25 |
Family
ID=69913855
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911402586.3A Active CN110940358B (zh) | 2019-12-31 | 2019-12-31 | 一种激光雷达和惯导联合标定的装置及标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110940358B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112904317A (zh) * | 2021-01-21 | 2021-06-04 | 湖南阿波罗智行科技有限公司 | 一种多激光雷达与gnss_ins系统标定方法 |
CN113848541A (zh) * | 2021-09-22 | 2021-12-28 | 深圳市镭神智能系统有限公司 | 一种标定的方法、装置、无人机及计算机可读存储介质 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1496611A (en) * | 1974-01-03 | 1977-12-30 | Australia Dept Of Mfg Ind | Corner reflector for navigation and remote indication |
US20160291145A1 (en) * | 2015-04-06 | 2016-10-06 | GM Global Technology Operations LLC | Wheel detection and its application in object tracking and sensor registration |
CN108132442A (zh) * | 2017-12-13 | 2018-06-08 | 中国船舶重工集团公司第七〇九研究所 | 一种基于离线数据驱动的蓄电池联合状态估算方法 |
CN108594187A (zh) * | 2017-12-25 | 2018-09-28 | 深圳市道通科技股份有限公司 | 一种车载雷达标定设备及方法 |
CN109901138A (zh) * | 2018-12-28 | 2019-06-18 | 文远知行有限公司 | 激光雷达标定方法、装置、设备和存储介质 |
CN110148180A (zh) * | 2019-04-22 | 2019-08-20 | 河海大学 | 一种激光雷达与相机融合装置与标定方法 |
CN209400381U (zh) * | 2018-12-29 | 2019-09-17 | 徐州治鼎环境科技有限公司 | 一种便于取样校准的烟尘浓度检测装置 |
CN110456328A (zh) * | 2019-07-24 | 2019-11-15 | 佛山市云展智能科技有限公司 | 多线激光雷达标定系统及标定方法 |
CN110497373A (zh) * | 2019-08-07 | 2019-11-26 | 大连理工大学 | 一种移动作业机器人的三维激光雷达与机械臂间的联合标定方法 |
CN211205331U (zh) * | 2019-12-31 | 2020-08-07 | 徐州治鼎环境科技有限公司 | 一种激光雷达和惯导联合标定的装置 |
-
2019
- 2019-12-31 CN CN201911402586.3A patent/CN110940358B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1496611A (en) * | 1974-01-03 | 1977-12-30 | Australia Dept Of Mfg Ind | Corner reflector for navigation and remote indication |
US20160291145A1 (en) * | 2015-04-06 | 2016-10-06 | GM Global Technology Operations LLC | Wheel detection and its application in object tracking and sensor registration |
CN108132442A (zh) * | 2017-12-13 | 2018-06-08 | 中国船舶重工集团公司第七〇九研究所 | 一种基于离线数据驱动的蓄电池联合状态估算方法 |
CN108594187A (zh) * | 2017-12-25 | 2018-09-28 | 深圳市道通科技股份有限公司 | 一种车载雷达标定设备及方法 |
CN109901138A (zh) * | 2018-12-28 | 2019-06-18 | 文远知行有限公司 | 激光雷达标定方法、装置、设备和存储介质 |
CN209400381U (zh) * | 2018-12-29 | 2019-09-17 | 徐州治鼎环境科技有限公司 | 一种便于取样校准的烟尘浓度检测装置 |
CN110148180A (zh) * | 2019-04-22 | 2019-08-20 | 河海大学 | 一种激光雷达与相机融合装置与标定方法 |
CN110456328A (zh) * | 2019-07-24 | 2019-11-15 | 佛山市云展智能科技有限公司 | 多线激光雷达标定系统及标定方法 |
CN110497373A (zh) * | 2019-08-07 | 2019-11-26 | 大连理工大学 | 一种移动作业机器人的三维激光雷达与机械臂间的联合标定方法 |
CN211205331U (zh) * | 2019-12-31 | 2020-08-07 | 徐州治鼎环境科技有限公司 | 一种激光雷达和惯导联合标定的装置 |
Non-Patent Citations (3)
Title |
---|
朱泽锋;张恒华;王鹏宇;: "高精度测量雷达安装误差的测试和调平方法研究", 计量与测试技术, no. 06 * |
王春梅: "装车机器人激光雷达测量系统及其标定方法", 《光电工程》 * |
韩栋斌: "基于手眼模型的三维激光雷达外参数标定", pages 798 - 805 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112904317A (zh) * | 2021-01-21 | 2021-06-04 | 湖南阿波罗智行科技有限公司 | 一种多激光雷达与gnss_ins系统标定方法 |
CN112904317B (zh) * | 2021-01-21 | 2023-08-22 | 湖南阿波罗智行科技有限公司 | 一种多激光雷达与gnss_ins系统标定方法 |
CN113848541A (zh) * | 2021-09-22 | 2021-12-28 | 深圳市镭神智能系统有限公司 | 一种标定的方法、装置、无人机及计算机可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN110940358B (zh) | 2023-07-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107144273B (zh) | 基于倾角传感的室内测量定位系统基站姿态自动补偿方法 | |
CN109685858B (zh) | 一种单目摄像头在线标定方法 | |
CN110031829B (zh) | 一种基于单目视觉的目标精准测距方法 | |
CN109794963B (zh) | 一种面向曲面构件的机器人快速定位方法 | |
CN112836737A (zh) | 一种基于车路数据融合的路侧组合感知设备在线标定方法 | |
CN109323650B (zh) | 测量系统中视觉图像传感器与光点测距传感器测量坐标系的统一方法 | |
CN101539397B (zh) | 物体三维姿态的精密光学测量方法 | |
CN110715665B (zh) | 一种田间作物表型监测机器人及其导航方法 | |
CN104794743A (zh) | 一种车载激光移动测量系统彩色点云生产方法 | |
CN110940358A (zh) | 一种激光雷达和惯导联合标定的装置及标定方法 | |
CN103529838A (zh) | 自动导引车的多目视觉导引驱动装置及其协同标定方法 | |
CN109773686B (zh) | 一种用于机器人装配的点激光线标定方法及系统 | |
CN111733673B (zh) | 基于移动平台的路面不平度非接触测量方法及其装置 | |
CN109974608B (zh) | 基于机器视觉技术的零件孔径尺寸测量方法 | |
CN108469728B (zh) | 一种机载LiDAR姿态角补偿装置解耦控制方法 | |
CN109685845B (zh) | 一种用于fod检测机器人的基于pos系统的实时图像拼接处理方法 | |
CN111043963A (zh) | 基于二维激光雷达的车厢容器的三维扫描系统测量方法 | |
CN102663727B (zh) | 基于cmm移动靶标的相机分区域标定方法 | |
CN112731354A (zh) | Agv上激光雷达位姿的自标定方法 | |
CN111678534A (zh) | 一种结合rgbd双目深度相机、imu和多线激光雷达的联合标定平台和方法 | |
CN108664043B (zh) | 基于双目视觉的驾驶员特征点测量装置及其控制方法 | |
CN114474003A (zh) | 一种基于参数辨识的车载建筑机器人误差补偿方法 | |
CN211205331U (zh) | 一种激光雷达和惯导联合标定的装置 | |
CN109712198A (zh) | 一种高级驾驶辅助系统的标定方法 | |
CN109342008B (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 |