CN211205331U - 一种激光雷达和惯导联合标定的装置 - Google Patents
一种激光雷达和惯导联合标定的装置 Download PDFInfo
- Publication number
- CN211205331U CN211205331U CN201922463317.XU CN201922463317U CN211205331U CN 211205331 U CN211205331 U CN 211205331U CN 201922463317 U CN201922463317 U CN 201922463317U CN 211205331 U CN211205331 U CN 211205331U
- Authority
- CN
- China
- Prior art keywords
- hydraulic cylinder
- laser radar
- tray
- inertial navigation
- calibration
- 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.)
- Active
Links
Images
Landscapes
- 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 (3)
1.一种激光雷达和惯导联合标定的装置，其特征在于：包括托盘（1）、液压缸Ⅰ（2）、液压缸Ⅱ（3）；所述的托盘（1）下端的四个角各垂直连接一个液压缸Ⅰ（2）；所述的托盘（1）下端中部通过万向头（31）连接液压缸Ⅱ（3）。
2.根据权利要求1所述一种激光雷达和惯导联合标定的装置，其特征在于：所述液压缸Ⅰ（2）和托盘（1）通过弹簧（21）或橡胶垫连接。
3.根据权利要求1所述一种激光雷达和惯导联合标定的装置，其特征在于：所述激光雷达和惯导联合标定的装置还包括控制***，所述控制***包括依次连接的输入模块、中央处理器、输出模块，所述输出模块分别与液压缸Ⅰ（2）和液压缸Ⅱ（3）连接；所述输入模块用于设定托盘的目标姿态，所述中央处理器用于计算液压缸Ⅰ（2）和液压缸Ⅱ（3）的升降量和升降速度，所述输出模块用于控制液压缸Ⅰ（2）和液压缸Ⅱ（3）的升降。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201922463317.XU CN211205331U (zh) | 2019-12-31 | 2019-12-31 | 一种激光雷达和惯导联合标定的装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201922463317.XU CN211205331U (zh) | 2019-12-31 | 2019-12-31 | 一种激光雷达和惯导联合标定的装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN211205331U true CN211205331U (zh) | 2020-08-07 |
Family
ID=71851091
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201922463317.XU Active CN211205331U (zh) | 2019-12-31 | 2019-12-31 | 一种激光雷达和惯导联合标定的装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN211205331U (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110940358A (zh) * | 2019-12-31 | 2020-03-31 | 徐州治鼎环境科技有限公司 | 一种激光雷达和惯导联合标定的装置及标定方法 |
-
2019
- 2019-12-31 CN CN201922463317.XU patent/CN211205331U/zh active Active
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110940358A (zh) * | 2019-12-31 | 2020-03-31 | 徐州治鼎环境科技有限公司 | 一种激光雷达和惯导联合标定的装置及标定方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109308693B (zh) | 由一台ptz相机构建的目标检测和位姿测量单双目视觉*** | |
| CN110940358B (zh) | 一种激光雷达和惯导联合标定的装置及标定方法 | |
| CN113870343B (zh) | 相对位姿标定方法、装置、计算机设备和存储介质 | |
| CN110119698B (zh) | 用于确定对象状态的方法、装置、设备和存储介质 | |
| CN112037159B (zh) | 一种跨相机道路空间融合及车辆目标检测跟踪方法及*** | |
| CN110426051A (zh) | 一种车道线绘制方法、装置及存储介质 | |
| CN109470255B (zh) | 基于高精度定位及车道线识别的高精度地图自动生成方法 | |
| US9715730B2 (en) | Three-dimensional measurement apparatus and robot system | |
| CN107389026A (zh) | 一种基于固定点射影变换的单目视觉测距方法 | |
| CN103198477B (zh) | 一种采用苹果套袋机器人进行视觉定位的方法 | |
| CN108801142A (zh) | 一种特大尺寸工件双移动测量机器人***及方法 | |
| CN106774296A (zh) | 一种基于激光雷达和ccd摄像机信息融合的障碍检测方法 | |
| CN112734841B (zh) | 一种用轮式里程计-imu和单目相机实现定位的方法 | |
| CN107390205A (zh) | 一种利用车联网获取前车特征的单目视觉车辆测距方法 | |
| CN111873744B (zh) | 基于相机传感器路面信息识别的主动悬架预瞄控制方法 | |
| CN104715469A (zh) | 一种数据处理方法及电子设备 | |
| CN109465830B (zh) | 机器人单目立体视觉标定***及方法 | |
| CN105654476A (zh) | 基于混沌粒子群优化算法的双目标定方法 | |
| CN108180834A (zh) | 一种工业机器人同三维成像仪位姿关系现场实时标定方法 | |
| CN111733673B (zh) | 基于移动平台的路面不平度非接触测量方法及其装置 | |
| CN111862235A (zh) | 双目相机自标定方法及*** | |
| CN211205331U (zh) | 一种激光雷达和惯导联合标定的装置 | |
| CN108664043B (zh) | 基于双目视觉的驾驶员特征点测量装置及其控制方法 | |
| CN111413689B (zh) | 一种基于rviz实现多激光雷达点云对齐的高效静态标定方法 | |
| CN116839570B (zh) | 一种基于传感器融合目标检测的作物行间作业导航方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| GR01 | Patent grant | ||
| GR01 | Patent grant |