CN112485773B - 激光雷达与倾角传感器的外参信息标定方法 - Google Patents

激光雷达与倾角传感器的外参信息标定方法 Download PDF

Info

Publication number
CN112485773B
CN112485773B CN202011236201.3A CN202011236201A CN112485773B CN 112485773 B CN112485773 B CN 112485773B CN 202011236201 A CN202011236201 A CN 202011236201A CN 112485773 B CN112485773 B CN 112485773B
Authority
CN
China
Prior art keywords
coordinate system
laser radar
calibration
rotation matrix
normal vector
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
Application number
CN202011236201.3A
Other languages
English (en)
Other versions
CN112485773A (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.)
National Defense Technology Innovation Institute PLA Academy of Military Science
Original Assignee
National Defense Technology Innovation Institute PLA Academy of Military Science
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 National Defense Technology Innovation Institute PLA Academy of Military Science filed Critical National Defense Technology Innovation Institute PLA Academy of Military Science
Priority to CN202011236201.3A priority Critical patent/CN112485773B/zh
Publication of CN112485773A publication Critical patent/CN112485773A/zh
Application granted granted Critical
Publication of CN112485773B publication Critical patent/CN112485773B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497Means for monitoring or calibrating
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/10Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation

Landscapes

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

Abstract

本发明公开了一种激光雷达与倾角传感器的外参信息标定方法,包括:将激光雷达和倾角传感器固连;将激光雷达和倾角传感器放置在标定场地,记录倾角传感器的输出数据;在标定场地放置一个标定辅助设备;在标定场地放置一个标定板,并设置若干个视觉标志点;利用标定辅助设备对准视觉标志点,测量视觉标志点的位置信息,估计标定板平面的法向量;利用激光雷达在标定板上采集点云数据,估计标定板平面的法向量;移动标定板若干次,获取若干个标定板平面的法向量组;调整激光雷达和倾角传感器的放置位置,获取多组数据组;确定激光雷达与倾角传感器的外参信息。本发明的方法通过利用标定辅助设备和标定板,能实现激光雷达与倾角传感器的外参信息标定。

Description

激光雷达与倾角传感器的外参信息标定方法
技术领域
本发明涉及激光雷达技术领域,具体涉及一种激光雷达与倾角传感器的外参信息标定方法。
背景技术
激光雷达是一种可以精确探测物体位置的传感器,激光雷达通过对目标物体发射激光信号,根据从目标物体反射回来的信号时间差来计算激光雷达与目标物体间的距离,然后根据发射激光的角度来确定目标物体和发射器的角度,从而得出目标物体与激光发射器的相对位置。激光雷达由于具备高精度和高分辨率等测量优势,已被广泛应用于各个行业。目前基于激光雷达获得的点云数据,通过点云匹配的方法可以估计目标的三维位姿信息。
由于高精度的倾角传感器具有体积小、功耗低、稳定性高和抗干扰能力强等优点,为此,可以通过在激光传感器和目标上安装倾角传感器,利用倾角传感器提供额外的角度约束信息,提高目标位姿估计的精度。
其中,为了实现激光雷达和倾角传感器的两者信息融合,需要精确标定激光传感器和倾角传感器的外参信息。
当前,激光雷达和惯性测量器件之间的外参标定方法已较为成熟。具体地,激光雷达和惯性测量器件绑定到一起运动,激光雷达通过点云匹配得到位姿信息和惯性器件加速度和角速度积分得到的位姿信息具有相关性,通过上述信息利用优化算法可以求解两者之间的外参信息。但是,由于倾角传感器的输出仅包含与水平面的夹角,现有的外参标定方法并不能用于激光雷达和倾角传感器的外参信息标定。
发明内容
为解决上述现有技术中存在的技术问题,本发明提供一种激光雷达与倾角传感器的外参信息标定方法。
为此,本发明公开了一种激光雷达与倾角传感器的外参信息标定方法,包括:
将激光雷达和倾角传感器固定连接;
将激光雷达和倾角传感器固定放置在设定的标定场地内,记录倾角传感器的输出数据;
在标定场地内放置一个标定辅助设备,并对标定辅助设备进行调水平;
在标定场地内放置一个激光雷达标定板,并在标定板平面内设置若干个视觉标志点,若干个视觉标志点中至少存在三个不共线的视觉标志点;
利用标定辅助设备对准标定板的视觉标志点,测量视觉标志点的位置信息,根据视觉标志点的位置信息估计标定板平面的法向量;
利用激光雷达在标定板上采集不少于两条不重合直线的点云数据,根据点云数据估计标定板平面的法向量;
移动标定板若干次,获取若干个标定板平面的法向量组,每个法向量组包括一个基于位置信息的法向量和一个基于点云数据的法向量;
调整激光雷达和倾角传感器在标定场地内的放置位置,获取多组数据组,每个数据组包括一个倾角传感器的输出数据和若干个标定板平面的法向量组;
根据多组数据组确定激光雷达与倾角传感器的外参信息。
在一些可选的实施方式中,所述标定辅助设备为全站仪。
在一些可选的实施方式中,所述根据多组数据组确定激光雷达与倾角传感器的外参信息,包括:
选取多组数据组中的一组数据组;
根据选取的一组数据组,确定倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系;
根据选取的一组数据组,确定标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系;
基于倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系和标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系,确定倾角传感器坐标系与激光雷达坐标系之间的旋转关系;
根据倾角传感器坐标系与激光雷达坐标系之间的旋转关系确定倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组;
依次选取多组数据组中的剩余数据组,确定每个数据组对应的倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组,利用多个旋转矩阵求解方程组确定倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵。
在一些可选的实施方式中,设定:选取的数据组为第m组,世界坐标系绕Z轴、Y轴和X轴旋转αm、βm和γ′m得到倾角传感器坐标系;
倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系表述为:
Figure BDA0002766748190000031
Figure BDA0002766748190000032
表示在第m组数据组下的倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转矩阵,
Figure BDA0002766748190000033
γm和βm表示第m组数据组中倾角传感器坐标系中X轴和Y轴的输出数据,αm为设定参数。
在一些可选的实施方式中,设定:第m组数据组中世界坐标系与激光雷达坐标系之间的平移矩阵忽略不计;
标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系表述为:
Figure BDA0002766748190000034
Figure BDA0002766748190000035
表示标定辅助设备世界坐标系与激光雷达坐标系之间的旋转矩阵,
Figure BDA0002766748190000036
Figure BDA0002766748190000037
表示旋转矩阵
Figure BDA0002766748190000038
的内部参数。
在一些可选的实施方式中,旋转矩阵
Figure BDA0002766748190000039
的内部参数
Figure BDA00027667481900000310
Figure BDA00027667481900000311
通过以下方式求解:
设定:
Figure BDA00027667481900000312
Figure BDA00027667481900000313
表示第m组数据组中第i个法向量组中标定辅助设备世界坐标系下标定板平面的法向量和激光雷达坐标系下标定板平面的法向量;
对公式
Figure BDA00027667481900000314
进行展开处理,得到三个方程组
Figure BDA00027667481900000315
Figure BDA00027667481900000316
Figure BDA00027667481900000317
Figure BDA00027667481900000318
Figure BDA00027667481900000319
选取若干个法向量组中至少三个不平行的法向量组,获取每个法向量组对应的三个方程组;
利用获取的所有方程组,求解得到旋转矩阵
Figure BDA0002766748190000041
的内部参数。
在一些可选的实施方式中,还包括构造正交约束为:
Figure BDA0002766748190000042
Figure BDA0002766748190000043
Figure BDA0002766748190000044
Figure BDA0002766748190000045
Figure BDA0002766748190000046
Figure BDA0002766748190000047
构造最优函数为:
Figure BDA0002766748190000048
ρ表示惩罚因子;
在求解旋转矩阵
Figure BDA0002766748190000049
的内部参数
Figure BDA00027667481900000410
Figure BDA00027667481900000411
时,将正交约束和最优函数引入方程组求解过程,以提高旋转矩阵的求解精度。
在一些可选的实施方式中,倾角传感器坐标系与激光雷达坐标系之间的旋转关系表述为:
Figure BDA00027667481900000412
Figure BDA00027667481900000413
表示倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵,
Figure BDA00027667481900000414
Figure BDA00027667481900000415
表示旋转矩阵
Figure BDA00027667481900000416
的内部参数;
旋转矩阵
Figure BDA00027667481900000417
满足以下的转换公式;
Figure BDA0002766748190000051
Figure BDA0002766748190000052
表示倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转矩阵,
Figure BDA0002766748190000053
表示标定辅助设备世界坐标系与激光雷达坐标系之间的旋转矩阵。
在一些可选的实施方式中,倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组通过以下方式确定:
设定:
Figure BDA0002766748190000054
对转换公式
Figure BDA0002766748190000055
进行展开处理,得到第m组数据组对应的三个旋转矩阵求解方程组
Figure BDA0002766748190000056
Figure BDA0002766748190000057
Figure BDA0002766748190000058
Figure BDA0002766748190000059
Figure BDA00027667481900000510
利用M组数据组得到所有旋转矩阵求解方程组
Figure BDA00027667481900000511
在一些可选的实施方式中,还包括构造正交约束为:
Figure BDA00027667481900000512
Figure BDA00027667481900000513
Figure BDA00027667481900000514
Figure BDA00027667481900000515
Figure BDA00027667481900000516
Figure BDA00027667481900000517
构造最优函数为:
Figure BDA00027667481900000518
ρ表示惩罚因子;
在求解旋转矩阵
Figure BDA0002766748190000061
的内部参数
Figure BDA0002766748190000062
Figure BDA0002766748190000063
时,将正交约束和最优函数引入方程组求解过程,以提高旋转矩阵的求解精度。
本发明技术方案的主要优点如下:
本发明的激光雷达与倾角传感器的外参信息标定方法通过利用如全站仪的标定辅助设备和标定板,能够实现激光雷达与倾角传感器的外参信息标定,标定精度高,适用范围广。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明一实施例的激光雷达与倾角传感器的外参信息标定方法的流程图;
图2为本发明一实施例的倾角传感器坐标系与水平面坐标系的关系示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明具体实施例及相应的附图对本发明技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本发明的一部分实施例,而不是全部的实施例。基于本发明的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
以下结合附图,详细说明本发明实施例提供的技术方案。
如附图1所示,本发明一实施例提供了一种激光雷达与倾角传感器的外参信息标定方法,该方法包括:
将激光雷达和倾角传感器固定连接;
将激光雷达和倾角传感器固定放置在设定的标定场地内,记录倾角传感器的输出数据;
在标定场地内放置一个标定辅助设备,并对标定辅助设备进行调水平;
在标定场地内放置一个激光雷达标定板,并在标定板平面内设置若干个视觉标志点,若干个视觉标志点中至少存在三个不共线的视觉标志点;
利用标定辅助设备对准标定板的视觉标志点,测量视觉标志点的位置信息,根据视觉标志点的位置信息估计标定板平面的法向量;
利用激光雷达在标定板上采集不少于两条不重合直线的点云数据,根据点云数据估计标定板平面的法向量;
移动标定板若干次,获取若干个标定板平面的法向量组,每个法向量组包括一个基于位置信息的法向量和一个基于点云数据的法向量;
调整激光雷达和倾角传感器在标定场地内的放置位置,获取多组数据组,每个数据组包括一个倾角传感器的输出数据和若干个标定板平面的法向量组;
根据多组数据组确定激光雷达与倾角传感器的外参信息。
以下对本发明一实施例提供的激光雷达与倾角传感器的外参信息标定方法的各个步骤进行具体说明。
S1,将激光雷达和倾角传感器固定连接;
具体地,在进行外参信息标定的过程中,将激光雷达和倾角传感器固定连接,以保证两者之间的相对位姿关系不会发生变化。
在实际应用过程中,尽可能地保证激光雷达和倾角传感器安装在同一水平面内或者平行的水平面内,两者之间的旋转角变化尽可能小,以提高标定的精度。
S2,将激光雷达和倾角传感器固定放置在设定的标定场地内,记录倾角传感器的输出数据;
具体地,将激光雷达和倾角传感器放置在设定的标定场地内,并保证激光雷达和倾角传感器在后续的外参信息标定过程中保持恒定,而后记录倾角传感器的输出数据。
本发明一实施例中,采集倾角传感器的多组输出数据,取多组输出数据的平均值作为输出数据的最终值,以滤除倾角传感器的高斯误差。
倾角传感器的输出数据包括倾角传感器X轴和Y轴的输出数据,如附图2所示,本发明一实施例中,设定倾角传感器坐标系F(S)中X轴和Y轴的输出数据分别为γ和β。X轴的输出数据γ表示倾角传感器X轴与水平面的夹角,Y轴的输出数据β表示倾角传感器Y轴与水平面的夹角。
S3,在标定场地内放置一个标定辅助设备,并对标定辅助设备进行调水平;
本发明一实施例中,标定辅助设备可以采用全站仪。
具体地,在设定的标定场地内放置一个全站仪,并将全站仪调水平,以建立一个世界坐标系F(W)。其中,该世界坐标系的Z轴垂直于水平面向上或向下,X轴和Y轴在水平面内,以保证利用全站仪估计的标定板平面的法向量能够表示在倾角传感器坐标系,本发明一实施例中设定世界坐标系的Z轴垂直于水平面向上。
当然,标定辅助设备也可以采用其他设备,只能够辅助建立一个Z轴垂直于水平面、X轴和Y轴在水平面内的世界坐标系,同时利用该标定辅助设备能够识别标定板。
S4,在标定场地内放置一个激光雷达标定板,并在标定板平面内设置若干个视觉标志点,若干个视觉标志点中至少存在三个不共线的视觉标志点;
由于同一平面内不共线的三点能够确定该平面,为此,本发明一实施例中,将激光雷达标定板放置在激光雷达视野范围内,并在标定板平面内设置至少包括三个不共线的视觉标志点的若干个视觉标志点,以满足后续标定使用需求。
此外,标定板的平整度需要在设定精度范围内,以尽可能保证标定板平面内各处的法向量的一致。其中,设定精度范围根据实际标定精度要求进行设置。
S5,利用标定辅助设备对准标定板的视觉标志点,测量视觉标志点的位置信息,根据视觉标志点的位置信息估计标定板平面的法向量;
具体地,使全站仪对准标定板的视觉标志点,利用全站仪测量多个视觉标志点的位置,根据测量的多个视觉标志点的位置信息,利用随机采样一致性(RANSAC)算法或最小二乘算法估计出标定板平面的法向量wn
假设标定板平面为Ax+By+Cz+D=0,平面法向量为
Figure BDA0002766748190000081
测量的多个视觉标志点的位置数据为(xi,yi,zi),xi、yi和zi表示第i个视觉标志点在全站仪世界坐标系F(W)下的Z轴、Y轴和X轴坐标;利用随机采样一致性(RANSAC)算法或最小二乘算法可以估计出A、B、C、D的参数,从而估计出标定板平面的法向量wn
S6,利用激光雷达在标定板上采集不少于两条不重合直线的点云数据,根据点云数据估计标定板平面的法向量;
利用激光雷达在标定板上采集不少于两条不重合直线的点云数据,利用两条不重合直线的三维点云数据确定激光雷达坐标系F(L)下标定板平面的法向量Ln
具体地,与步骤S5中法向量的求解过程相同,使用激光雷达获得的三维点云替代视觉标志点,获取相应的视觉标志点的位置数据,根据位置数据利用随机采样一致性(RANSAC)算法或最小二乘算法估计出标定板平面的法向量Ln
S7,移动标定板若干次,获取若干个标定板平面的法向量组,每个法向量组包括一个基于点云数据的法向量和一个基于位置信息的法向量;
具体地,每移动一次标定板,确定一个世界坐标系F(W)下标定板平面的法向量wn和一个激光雷达坐标系F(L)下标定板平面的法向量Ln,移动标定板K(K≥3)次,获取K个标定板平面的法向量组(wn i,Ln i),i=1,2,...,K,wn i和Ln i表示第i个法向量组中世界坐标系F(W)下标定板平面的法向量和激光雷达坐标系F(L)下标定板平面的法向量。
S8,调整激光雷达和倾角传感器在标定场地内的放置位置,获取多组数据组,每个数据组包括一个倾角传感器的输出数据和若干个标定板平面的法向量组;
具体地,每调整一次激光雷达和倾角传感器在标定场地内的放置位置,记录一次倾角传感器的输出数据,并重复步骤S5-S7,获取包括一个倾角传感器的输出数据和K个标定板平面的法向量组的数据组,调整激光雷达和倾角传感器在标定场地内的放置位置M(M≥3)次,获取M组数据组
Figure BDA0002766748190000091
γm和βm表示第m次位置调整时对应的倾角传感器的输出数据,
Figure BDA0002766748190000092
Figure BDA0002766748190000093
表示第m次位置调整时第i个法向量组中世界坐标系F(W)下标定板平面的法向量和激光雷达坐标系F(L)下标定板平面的法向量。
S9,根据多组数据组确定激光雷达与倾角传感器的外参信息;
激光雷达和倾角传感器的外参信息包括旋转矩阵
Figure BDA0002766748190000095
和平移矩阵T。由于倾角传感器无定位功能,所以可设定倾角传感器坐标系的原点与激光雷达坐标系的原点重合,此时平移矩阵T=0。为此,激光雷达与倾角传感器的外参信息标定只需标定旋转矩阵
Figure BDA0002766748190000096
具体地,本发明一实施例中,根据多组数据组确定激光雷达与倾角传感器的外参信息,包括以下步骤S91-S96:
S91,选取多组数据组中的一组数据组;
从M组数据组
Figure BDA0002766748190000094
中任意选取一组数据组,例如选取第m组数据组。
S92,根据选取的一组数据组,确定倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系;
第m组数据组中,倾角传感器的X轴和Y轴的输出数据分别为γm和βm,设定:世界坐标系F(W)绕Z轴、Y轴和X轴旋转αm、βm
Figure BDA0002766748190000101
得到倾角传感器坐标系F(S);
根据倾角传感器坐标系和世界坐标系的变换关系的推导过程知,倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系可表述为:
Figure BDA0002766748190000102
Figure BDA0002766748190000103
表示在第m组数据组下的倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转矩阵,αm为设定的未知参数。
倾角传感器坐标系到世界坐标系的变换关系的推导过程如下:
倾角传感器测量过程中倾角传感器坐标系的参考面为水平面,双轴倾角传感器两个轴(X轴和Y轴)输出值为自身X轴和Y轴与参考水平面间的夹角γ和β,参考水平面上定义的坐标系F(G)和倾角传感器坐标系F(S)都过原点O。
如附图2所示,从倾角传感器X轴上一点F做参考水平面的垂线,与参考水平面相交于E点,OE直线为坐标系F(G)的X1轴(β=0时,X1轴和X轴重合);在参考水平面内做垂直于X1轴的垂线OD,OD直线为坐标系F(G)的Y1轴。其中,X1轴与X轴的夹角与倾角传感器的X轴输出相同,均为β,Y1轴与Y轴的夹角为γ′。坐标系F(G)首先绕Y1轴旋转β,然后绕变换后的坐标系X轴旋转γ′,可以得到倾角传感器坐标系F(S),故有:
Figure BDA0002766748190000104
可知,为了求解旋转矩阵,需要确定γ′。
过倾角传感器Y轴上一点A做垂直于参考水平面的垂线,与参考水平面相交于B点;同时过点A做垂直于Y1轴的垂线垂直于D点(γ=0时,Y1轴和Y轴重合)。
当γ=0时,Y1轴和Y轴重合,有γ′=γ=0。
当β=0时,X1轴和X轴重合,Y轴与参考水平面的垂线同Y轴与Y1轴垂线重合,γ′=γ。
证明:过Y轴做Y1轴垂线AD。X1轴和X轴,X1轴垂直于Y1轴与Y轴张成的平面OAD,则AD同时垂直于X1轴与Y1轴,则AD为参考水平面的垂线,故有γ′=γ。
当γ≠0,β≠0时,
Figure BDA0002766748190000111
证明:由于OD⊥AD,OD⊥AB,则OD⊥平面ABD;由于OD⊥FE,OD⊥OE,则OD⊥平面OFE;因此,有平面OFE∥平面ABD。由于DB与OE均位于参考水平面内,且均与参考水平面内的直线OD垂直,则有DB∥OE。
过A点可以做X轴的平行线AM,其与DB延长线必相交,设定交点为C,故有:△FOE∽△ACB,AM⊥OA,AM⊥OD,AM⊥平面OAD,AM⊥AD,∠CAD=PI/2.0。
根据上述几何关系可知,∠BAD=β,∠DAO=90-γ′,∠BAO=90-γ,根据三余弦定理可知cos(90-γ)=cosβcos(90-γ′),故可以得到:
Figure BDA0002766748190000112
由于当γ=0时,
Figure BDA0002766748190000113
当β=0时,
Figure BDA0002766748190000114
Figure BDA0002766748190000115
始终成立。
设定世界坐标系F(W)绕Z轴旋转α可以使得世界坐标系F(W)与坐标系F(G)方向一致,则有:
Figure BDA0002766748190000116
因此,从倾角传感器坐标系F(S)与世界坐标系F(W)之间的变换关系可表示为:
Figure BDA0002766748190000117
S93,根据选取的一组数据组,确定标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系;
设定:第m组数据组中,标定辅助设备世界坐标系F(W)与激光雷达坐标系F(L)之间的平移矩阵忽略不计;则标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系可表述为:
Figure BDA0002766748190000121
Figure BDA0002766748190000122
表示标定辅助设备世界坐标系与激光雷达坐标系之间的旋转矩阵,
Figure BDA0002766748190000123
Figure BDA0002766748190000124
表示旋转矩阵
Figure BDA0002766748190000125
的内部参数。
进一步地,在已知若干个法向量组
Figure BDA0002766748190000126
的情况下,可以得到如下变换公式:
Figure BDA0002766748190000127
设定
Figure BDA0002766748190000128
Figure BDA0002766748190000129
表示第m组数据组中第i个法向量组中标定辅助设备世界坐标系下标定板平面的法向量和激光雷达坐标系下标定板平面的法向量,对上述的变换公式进行展开处理,得到如下的三个方程组
Figure BDA00027667481900001210
Figure BDA00027667481900001211
Figure BDA00027667481900001212
Figure BDA00027667481900001213
Figure BDA00027667481900001214
在第m组数据组中,每个标定板平面的法向量组都可以得到三个对应的方程组。由于旋转矩阵
Figure BDA00027667481900001215
包括9个待求解的内部参数,为此,选取第m组数据组中K个法向量组中至少三个不平行的法向量组,获取每个法向量组对应的三个方程组,利用获取的所有方程组
Figure BDA00027667481900001216
求解得到旋转矩阵
Figure BDA00027667481900001217
的9个内部参数。
具体地,上述的方程组可以表示为如下的矩阵形式:
Amem-bm=0
根据上述内容可知,Am和bm为已知参数,通过奇异值分解可以求解参数em,即确定旋转矩阵
Figure BDA0002766748190000131
的9个内部参数。
进一步地,由于上述方程组没有考虑旋转矩阵
Figure BDA0002766748190000132
内部的正交约束;为此,可以将正交约束引入方程求解过程,以保证求解结果符合实际要求。
具体地,构造正交约束为:
Figure BDA0002766748190000133
Figure BDA0002766748190000134
Figure BDA0002766748190000135
Figure BDA0002766748190000136
Figure BDA0002766748190000137
Figure BDA0002766748190000138
构造最优函数为:
Figure BDA0002766748190000139
其中,ρ表示惩罚因子。
由于em的初始值已经通过方程组求解得到,基于上述构造的正交约束和最优函数,可以进一步通过优化算法以得到em的精确值,从而提高旋转矩阵
Figure BDA00027667481900001310
的计算精度。
进一步地,若求解出来的矩阵
Figure BDA00027667481900001311
仍不是标准正交矩阵,则可通过奇异值分解使其正交化,也可通过以下公式进行正交化:
Figure BDA00027667481900001312
S94,基于倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系和标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系,确定倾角传感器坐标系与激光雷达坐标系之间的旋转关系;
由于倾角传感器与激光雷达固定连接,即倾角传感器坐标系与激光雷达坐标系两者固连,因此仅标定两者的旋转矩阵即可完成激光雷达与倾角传感器的外参信息标定。
本发明一实施例中,倾角传感器坐标系与激光雷达坐标系的旋转关系可表述为:
Figure BDA0002766748190000141
Figure BDA0002766748190000142
表示倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵,矩阵参数
Figure BDA0002766748190000143
Figure BDA0002766748190000144
表示旋转矩阵
Figure BDA0002766748190000145
的内部参数。
由于倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转矩阵为
Figure BDA0002766748190000146
标定辅助设备世界坐标系与激光雷达坐标系之间的旋转矩阵为
Figure BDA0002766748190000147
倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵为
Figure BDA00027667481900001419
为此,倾角传感器坐标系到标定辅助设备世界坐标系的转换关系可以表述为:
Figure BDA0002766748190000148
根据上述旋转矩阵
Figure BDA0002766748190000149
的表达式可知,旋转矩阵
Figure BDA00027667481900001410
的第三行参数与设定未知参数αm无关,因此,该行参数可以用于求解旋转矩阵
Figure BDA00027667481900001411
S95,根据倾角传感器坐标系与激光雷达坐标系之间的旋转关系确定倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组;
设定
Figure BDA00027667481900001412
对上述的转换公式
Figure BDA00027667481900001413
进行展开处理,得到如下的三个旋转矩阵求解方程组
Figure BDA00027667481900001414
Figure BDA00027667481900001415
Figure BDA00027667481900001416
Figure BDA00027667481900001417
Figure BDA00027667481900001418
S96,依次选取多组数据组中的剩余数据组,确定每个数据组对应的倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组,利用多个旋转矩阵求解方程组确定倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵。
由于每组数据组都可以得到三个旋转矩阵求解方程组,利用M组数据组则可以得到3M个旋转矩阵求解方程组。由于M大于等于3,旋转矩阵
Figure BDA0002766748190000151
包括9个待求解的内部参数;为此,利用M组数据组得到的所有旋转矩阵求解方程组
Figure BDA0002766748190000152
求解得到旋转矩阵
Figure BDA0002766748190000153
的9个内部参数
Figure BDA0002766748190000154
Figure BDA0002766748190000155
具体地,旋转矩阵求解方程组可以表示为如下的矩阵形式:
Aslesl-bsl=0
根据上述内容可知,Asl和bsl为已知参数,通过奇异值分解可以求解参数esl,即确定旋转矩阵
Figure BDA0002766748190000156
的9个内部参数
Figure BDA0002766748190000157
Figure BDA0002766748190000158
由于上述旋转矩阵求解方程组没有考虑旋转矩阵
Figure BDA0002766748190000159
内部的正交约束,为此,可以将正交约束引入方程求解中,以保证求解结果符合实际要求。
具体地,构造正交约束为:
Figure BDA00027667481900001510
Figure BDA00027667481900001511
Figure BDA00027667481900001512
Figure BDA00027667481900001513
Figure BDA00027667481900001514
Figure BDA00027667481900001515
构造最优函数为:
Figure BDA00027667481900001516
其中,ρ表示惩罚因子。
由于esl的初始值已经通过方程组求解得到,基于上述构造的正交约束和最优函数,可以进一步通过优化算法以得到esl的精确值,从而提高旋转矩阵
Figure BDA0002766748190000161
的计算精度。
进一步地,若求解出来的旋转矩阵
Figure BDA0002766748190000162
仍不是标准正交矩阵,则可以通过奇异值分解使其正交化,也可以通过以下公式进行正交化:
Figure BDA0002766748190000163
本发明一实施例提供的激光雷达与倾角传感器的外参信息标定方法通过利用如全站仪的标定辅助设备和标定板,能够实现激光雷达与倾角传感器的外参信息标定,标定精度高,适用范围广。
需要说明的是,在本文中,诸如“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。此外,本文中“前”、“后”、“左”、“右”、“上”、“下”均以附图中表示的放置状态为参照。
最后应说明的是:以上实施例仅用于说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。

Claims (9)

1.一种激光雷达与倾角传感器的外参信息标定方法,其特征在于,包括:
将激光雷达和倾角传感器固定连接;
将激光雷达和倾角传感器固定放置在设定的标定场地内,记录倾角传感器的输出数据;
在标定场地内放置一个标定辅助设备,并对标定辅助设备进行调水平;
在标定场地内放置一个激光雷达标定板,并在标定板平面内设置若干个视觉标志点,若干个视觉标志点中至少存在三个不共线的视觉标志点;
利用标定辅助设备对准标定板的视觉标志点,测量视觉标志点的位置信息,根据视觉标志点的位置信息估计标定板平面的法向量;
利用激光雷达在标定板上采集不少于两条不重合直线的点云数据,根据点云数据估计标定板平面的法向量;
移动标定板若干次,获取若干个标定板平面的法向量组,每个法向量组包括一个基于位置信息的法向量和一个基于点云数据的法向量;
调整激光雷达和倾角传感器在标定场地内的放置位置,获取多组数据组,每个数据组包括一个倾角传感器的输出数据和若干个标定板平面的法向量组;
根据多组数据组确定激光雷达与倾角传感器的外参信息,包括:
选取多组数据组中的一组数据组;
根据选取的一组数据组,确定倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系;
根据选取的一组数据组,确定标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系;
基于倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系和标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系,确定倾角传感器坐标系与激光雷达坐标系之间的旋转关系;
根据倾角传感器坐标系与激光雷达坐标系之间的旋转关系确定倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组;
依次选取多组数据组中的剩余数据组,确定每个数据组对应的倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组,利用多个旋转矩阵求解方程组确定倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵。
2.根据权利要求1所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,所述标定辅助设备为全站仪。
3.根据权利要求1所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,设定:选取的数据组为第m组,世界坐标系绕Z轴、Y轴和X轴旋转αm、βm和γ′m得到倾角传感器坐标系;
倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转关系表述为:
Figure FDA0004209504390000021
Figure FDA0004209504390000022
表示在第m组数据组下的倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转矩阵,
Figure FDA0004209504390000023
γm和βm表示第m组数据组中倾角传感器坐标系中X轴和Y轴的输出数据,αm为设定参数。
4.根据权利要求3所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,设定:第m组数据组中世界坐标系与激光雷达坐标系之间的平移矩阵忽略不计;
标定辅助设备世界坐标系与激光雷达坐标系之间的旋转关系表述为:
Figure FDA0004209504390000024
Figure FDA0004209504390000025
表示标定辅助设备世界坐标系与激光雷达坐标系之间的旋转矩阵,
Figure FDA00042095043900000215
Figure FDA00042095043900000216
表示旋转矩阵
Figure FDA0004209504390000026
的内部参数。
5.根据权利要求4所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,旋转矩阵
Figure FDA0004209504390000027
的内部参数
Figure FDA0004209504390000028
Figure FDA0004209504390000029
通过以下方式求解:
设定:
Figure FDA00042095043900000210
Figure FDA00042095043900000211
表示第m组数据组中第i个法向量组中标定辅助设备世界坐标系下标定板平面的法向量和激光雷达坐标系下标定板平面的法向量;
对公式
Figure FDA00042095043900000212
进行展开处理,得到三个方程组
Figure FDA00042095043900000213
Figure FDA00042095043900000214
Figure FDA0004209504390000031
Figure FDA0004209504390000032
Figure FDA0004209504390000033
选取若干个法向量组中至少三个不平行的法向量组,获取每个法向量组对应的三个方程组;
利用获取的所有方程组,求解得到旋转矩阵
Figure FDA0004209504390000034
的内部参数。
6.根据权利要求5所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,还包括构造正交约束为:
Figure FDA0004209504390000035
Figure FDA0004209504390000036
Figure FDA0004209504390000037
Figure FDA0004209504390000038
Figure FDA0004209504390000039
Figure FDA00042095043900000310
构造最优函数为:
Figure FDA00042095043900000311
ρ表示惩罚因子;
在求解旋转矩阵
Figure FDA00042095043900000312
的内部参数
Figure FDA00042095043900000313
Figure FDA00042095043900000314
时,将正交约束和最优函数引入方程组求解过程,以提高旋转矩阵的求解精度。
7.根据权利要求6所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,倾角传感器坐标系与激光雷达坐标系之间的旋转关系表述为:
Figure FDA0004209504390000041
Figure FDA0004209504390000042
表示倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵,
Figure FDA0004209504390000043
Figure FDA0004209504390000044
表示旋转矩阵
Figure FDA0004209504390000045
的内部参数;
旋转矩阵
Figure FDA0004209504390000046
满足以下的转换公式;
Figure FDA0004209504390000047
Figure FDA0004209504390000048
表示倾角传感器坐标系与标定辅助设备世界坐标系之间的旋转矩阵,
Figure FDA0004209504390000049
表示标定辅助设备世界坐标系与激光雷达坐标系之间的旋转矩阵。
8.根据权利要求7所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,倾角传感器坐标系与激光雷达坐标系之间的旋转矩阵求解方程组通过以下方式确定:
设定:
Figure FDA00042095043900000410
对转换公式
Figure FDA00042095043900000411
进行展开处理,得到第m组数据组对应的三个旋转矩阵求解方程组
Figure FDA00042095043900000412
Figure FDA00042095043900000413
Figure FDA00042095043900000414
Figure FDA00042095043900000415
Figure FDA00042095043900000416
利用M组数据组得到所有旋转矩阵求解方程组
Figure FDA00042095043900000417
9.根据权利要求8所述的激光雷达与倾角传感器的外参信息标定方法,其特征在于,还包括构造正交约束为:
Figure FDA00042095043900000418
Figure FDA00042095043900000419
Figure FDA00042095043900000420
Figure FDA0004209504390000051
Figure FDA0004209504390000052
Figure FDA0004209504390000053
构造最优函数为:
Figure FDA0004209504390000054
ρ表示惩罚因子;
在求解旋转矩阵
Figure FDA0004209504390000055
的内部参数
Figure FDA0004209504390000056
Figure FDA0004209504390000057
时,将正交约束和最优函数引入方程组求解过程,以提高旋转矩阵的求解精度。
CN202011236201.3A 2020-11-09 2020-11-09 激光雷达与倾角传感器的外参信息标定方法 Active CN112485773B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011236201.3A CN112485773B (zh) 2020-11-09 2020-11-09 激光雷达与倾角传感器的外参信息标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011236201.3A CN112485773B (zh) 2020-11-09 2020-11-09 激光雷达与倾角传感器的外参信息标定方法

Publications (2)

Publication Number Publication Date
CN112485773A CN112485773A (zh) 2021-03-12
CN112485773B true CN112485773B (zh) 2023-06-06

Family

ID=74928775

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011236201.3A Active CN112485773B (zh) 2020-11-09 2020-11-09 激光雷达与倾角传感器的外参信息标定方法

Country Status (1)

Country Link
CN (1) CN112485773B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113639782A (zh) * 2021-08-13 2021-11-12 北京地平线信息技术有限公司 车载传感器的外参标定方法和装置、设备和介质

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103049912A (zh) * 2012-12-21 2013-04-17 浙江大学 一种基于任意三面体的雷达-相机系统外部参数标定方法
CN103149560A (zh) * 2013-03-15 2013-06-12 中国人民解放军陆军军官学院 Ccd成像侧向激光雷达的标定方法
CN107153186A (zh) * 2017-01-06 2017-09-12 深圳市速腾聚创科技有限公司 激光雷达标定方法及激光雷达
WO2017206571A1 (zh) * 2016-05-31 2017-12-07 陈朝阳 一种采用激光扫描的目标定位方法及激光接收装置
CN109375195A (zh) * 2018-11-22 2019-02-22 中国人民解放军军事科学院国防科技创新研究院 一种基于正交法向量的多线激光雷达外参数快速标定方法
WO2019039728A1 (ko) * 2017-08-21 2019-02-28 (주)유진로봇 초소형 3차원 스캐닝 라이다 센서
CN111090084A (zh) * 2018-10-24 2020-05-01 舜宇光学(浙江)研究院有限公司 多激光雷达外参标定方法、标定装置、标定系统和电子设备
CN111207774A (zh) * 2020-01-17 2020-05-29 山东大学 一种用于激光-imu外参标定的方法及系统
CN111612845A (zh) * 2020-04-13 2020-09-01 江苏大学 一种基于移动标定板的激光雷达与相机联合标定方法
CN111708033A (zh) * 2020-06-17 2020-09-25 北京百度网讯科技有限公司 坐标系标定方法、装置、电子设备及存储介质

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103049912A (zh) * 2012-12-21 2013-04-17 浙江大学 一种基于任意三面体的雷达-相机系统外部参数标定方法
CN103149560A (zh) * 2013-03-15 2013-06-12 中国人民解放军陆军军官学院 Ccd成像侧向激光雷达的标定方法
WO2017206571A1 (zh) * 2016-05-31 2017-12-07 陈朝阳 一种采用激光扫描的目标定位方法及激光接收装置
CN107153186A (zh) * 2017-01-06 2017-09-12 深圳市速腾聚创科技有限公司 激光雷达标定方法及激光雷达
WO2019039728A1 (ko) * 2017-08-21 2019-02-28 (주)유진로봇 초소형 3차원 스캐닝 라이다 센서
CN111090084A (zh) * 2018-10-24 2020-05-01 舜宇光学(浙江)研究院有限公司 多激光雷达外参标定方法、标定装置、标定系统和电子设备
CN109375195A (zh) * 2018-11-22 2019-02-22 中国人民解放军军事科学院国防科技创新研究院 一种基于正交法向量的多线激光雷达外参数快速标定方法
CN111207774A (zh) * 2020-01-17 2020-05-29 山东大学 一种用于激光-imu外参标定的方法及系统
CN111612845A (zh) * 2020-04-13 2020-09-01 江苏大学 一种基于移动标定板的激光雷达与相机联合标定方法
CN111708033A (zh) * 2020-06-17 2020-09-25 北京百度网讯科技有限公司 坐标系标定方法、装置、电子设备及存储介质

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Cooperative People Tracking Using Multiple Ground Lidars Based on Distributed Interacting Multimodel Estimator;T. Nakahira et al.;《2019 6th International Conference on Control, Decision and Information Technologies (CoDIT)》;第946-951页 *
基于点云中心的激光雷达与相机联合标定方法研究;康国华 等;《仪器仪表学报》;第40卷(第12期);第118-126页 *
车载激光雷达外参数的标定方法;程金龙 等;《光电工程》;第40卷(第12期);第89-94页 *

Also Published As

Publication number Publication date
CN112485773A (zh) 2021-03-12

Similar Documents

Publication Publication Date Title
CN110296691B (zh) 融合imu标定的双目立体视觉测量方法与系统
CN111486802B (zh) 基于自适应距离加权的旋转轴标定方法
CN109807911B (zh) 基于gnss、uwb、imu、激光雷达、码盘的室外巡逻机器人多环境联合定位方法
CN105424058B (zh) 基于摄影测量技术的数码相机投影中心位置精确标定方法
CN107894241A (zh) 一种基于椭球拟合的无人机磁传感器校准方法、无人机
CN108648242B (zh) 基于激光测距仪辅助无公共视场的两相机标定方法及装置
CN101539397B (zh) 物体三维姿态的精密光学测量方法
CN109099883A (zh) 高精度大视场机器视觉测量与标定装置及方法
CN109959898B (zh) 一种座底式水声被动定位基阵自校准方法
CN110275139B (zh) 一种基于旋转式基元复用的超短基线定位系统及方法
CN109087355A (zh) 基于迭代更新的单目相机位姿测量装置与方法
CN108458710B (zh) 位姿测量方法
CN111798523A (zh) 星相机在轨定标定姿及遥感影像几何定位方法、系统
CN102207380B (zh) 一种高精度的横轴倾斜误差补偿方法
CN107727118B (zh) 大型飞行器中的gnc分系统设备姿态测量系统标定方法
CN111562563A (zh) 激光雷达转台标定方法、装置和计算机可读存储介质
CN112485773B (zh) 激光雷达与倾角传感器的外参信息标定方法
CN106767895A (zh) 利用标志点定向求解相机外方位元素的系统和方法
CN111915685A (zh) 一种变焦摄像机标定方法
CN110068313B (zh) 一种基于投影变换的数字天顶仪定向方法
CN108154535A (zh) 基于平行光管的摄像机标定方法
CN111220118B (zh) 基于视觉惯性导航系统的激光测距仪及测距方法
CN111710002B (zh) 一种基于Optitrack系统的相机外参标定方法
CN112965049A (zh) 一种多固态激光雷达的外参标定方法
CN111754584A (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