CN107179534A - 一种激光雷达参数自动标定的方法、装置及激光雷达 - Google Patents

一种激光雷达参数自动标定的方法、装置及激光雷达 Download PDF

Info

Publication number
CN107179534A
CN107179534A CN201710515747.4A CN201710515747A CN107179534A CN 107179534 A CN107179534 A CN 107179534A CN 201710515747 A CN201710515747 A CN 201710515747A CN 107179534 A CN107179534 A CN 107179534A
Authority
CN
China
Prior art keywords
marker
msub
laser radar
point
space coordinate
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
CN201710515747.4A
Other languages
English (en)
Other versions
CN107179534B (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 BEIKE TIANHUI TECHNOLOGY Co Ltd
Original Assignee
BEIJING BEIKE TIANHUI TECHNOLOGY Co Ltd
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 BEIKE TIANHUI TECHNOLOGY Co Ltd filed Critical BEIJING BEIKE TIANHUI TECHNOLOGY Co Ltd
Priority to CN201710515747.4A priority Critical patent/CN107179534B/zh
Publication of CN107179534A publication Critical patent/CN107179534A/zh
Application granted granted Critical
Publication of CN107179534B publication Critical patent/CN107179534B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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

Landscapes

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

Abstract

本发明公开了一种激光雷达参数自动标定的方法、装置及激光雷达。该方法包括:步骤10,在标定场中设置第一标志物,该第一标志物具有第一标志点,利用激光雷达对该标定场进行激光扫描,获取扫描数据:步骤20,对该第一标志物的所在位置处的扫描数据进行拟合,获取该第一标志点的拟合空间坐标;步骤30,利用该拟合空间坐标以及该第一标志点的测量空间坐标之间的误差,进行激光雷达参数的解算,利用解算出的激光雷达参数进行自动标定。本发明实现了对激光雷达的全自动和高精度标定,对激光点的密度要求更低,对标志物扫描的完整性要求低,还可对标定后的激光雷达测量精度进行自动精度检验和评估。

Description

一种激光雷达参数自动标定的方法、装置及激光雷达
技术领域
本发明涉及激光雷达技术领域,尤其涉及一种激光雷达参数自动标定的方法、装置及激光雷达。
背景技术
三维激光测量技术是一种高精度的空间信息获取手段,而为了实现激光雷达的高精度测量,须预先进行激光雷达参数的精确标定,以提高激光雷达测量精度,保证激光雷达在工作场景中输出数据的可靠性。
传统的激光雷达标定方法,通常在标定场中均匀布设若干三棱/四棱锥或反射片,在激光雷达完成对标定场的扫描后,由人工从扫描数据中提取锥面的激光点云,基于这些激光点云拟合锥顶的空间坐标后进一步解算激光雷达参数。
然而,人工提取锥面的激光点云会很大程度降低激光雷达的标定效率,延长标定作业周期,同时,人工操作也无法保证点云提取的精确度,难免有遗漏或错误。另外,由于三棱/四棱锥的锥面之间具有清晰的分界线,故而具有明确的方向性。如果扫描未能获取三个或三个以上锥面的点云时,由于部分锥面的信息缺失,故而无法拟合出锥顶的空间坐标,可见,三棱/四棱锥在标定过程中基于其形状对扫描完整度有更高的要求,纠错能力低。且如果位于锥面上激光点不足,也会降低锥顶空间坐标的拟合精度,因此对激光点云的密度有更高的要求。
发明内容
本发明解决的技术问题在于:实现对激光雷达的自动标定。
更进一步的,提高激光雷达标定的精确度。
更进一步的,降低对标志物扫描的完整度以及密度要求。
更进一步的,实现针对标定的自动精度检验和评估。
本发明公开了一种激光雷达参数自动标定的方法,该方法包括:
步骤10,在标定场中设置第一标志物,该第一标志物具有第一标志点,利用激光雷达对该标定场进行激光扫描,获取扫描数据:
步骤20,对该第一标志物的所在位置处的扫描数据进行拟合,获取该第一标志点的拟合空间坐标;
步骤30,利用该拟合空间坐标以及该第一标志点的测量空间坐标之间的误差,进行激光雷达参数的解算,利用解算出的激光雷达参数进行自动标定。
标定场中还设置有第二标志物,该第二标志物具有第二标志点,步骤30之后还包括:
步骤40,将解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据,对该第二标志物的所在位置处的更新扫描数据进行拟合,获取该第二标志点的拟合空间坐标,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
第一标志物为圆锥体,该第一标志点为圆锥顶点。
该步骤20进一步包括:
步骤21,在该第一标志物的所在位置处随机提取N个点的扫描数据;
步骤22,根据公式
进行最小二乘法解算,计算该第一标志物的模型参数,得到第一标志物模型,n=1,2,3……N,N大于等于初始化模型参数所需的最小样本数,(x0、y0、z0)为该第一标志物模型中的第一标志点的三维坐标,(xn、yn、zn)为该N个点中之一的三维坐标,α为圆锥顶角的一半,(i,j,k)为圆锥方向单位法向量,Ln为第一标志物模型,F为第一标志物模型函数;
步骤23,将该N个点中与该第一标志物模型的距离位于预定的第一阈值范围内的点作为内点;
在该第一标志物的所在位置处再次随机提取点集,迭代执行步骤22-23,直到内点的数量大于第一门槛值d时,利用所有的内点再次执行步骤22,得到更新后的第一标志物模型;
步骤24,利用该更新后的第一标志物模型的圆锥顶点作为该第一标志点的拟合空间坐标。
所述的方法在得到该更新后的第一标志物模型的步骤之后,还包括:
分别计算从该第一标志物的所在位置处随机提取的多个点各自相对该更新后的第一标志物模型表面的距离,若小于一距离阈值的数量大于等于一数量阈值,执行步骤24,否则放弃该第一标志物。
该步骤30针对多个第一标志物所得到多组该误差,利用如下激光雷达参数解算模型进行激光雷达参数d0、H、V、k1、k2、k3的解算:
ΔX=Gx(d0,H,V,k1,k2,k3)
ΔY=Gy(d0,H,V,k1,k2,k3)
ΔZ=Gz(d0,H,V,k1,k2,k3)
其中,ΔX为该拟合空间坐标的X轴数据与该测量空间坐标的X轴数据的差,ΔY为该拟合空间坐标的Y轴数据与该测量空间坐标的Y轴数据的差,ΔZ为该拟合空间坐标的Z轴数据与该测量空间坐标的Z轴数据的差,d0为测距误差,H为激光入射光线水平偏转,V为激光入射光线竖直偏转,k1,k2,k3为测角改正参数,Gx为X轴的激光雷达参数解算函数,Gy为Y轴的激光雷达参数解算函数,Gz为Z轴的激光雷达参数解算函数。
该第二标志物为球体,该第二标志点为球心,该步骤40进一步包括:
步骤41,利用解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据;
步骤42,在该第二标志物的所在位置处随机提取N个点的更新扫描数据;
步骤43,根据公式(X-a)2+(Y-b)2+(Z-c)2=R2,进行最小二乘法解算,计算该第二标志物的模型参数a、b、c、R,得到第二标志物模型,(a,b,c)为该第二标志物模型中的第二标志点的三维坐标,(X,Y,Z)为该N个点中之一的三维坐标,R为球面半径;
步骤44,将该N个点中与该第二标志物模型表面的距离位于预定的第二阈值范围内的点作为内点;
在该第二标志物的所在位置处再次随机提取点集,迭代执行步骤43-44,直到内点的数量大于第二门槛值时,利用所有的内点再次执行步骤43,得到更新后的第二标志物模型;
步骤45,利用该更新后的第二标志物模型的球心作为该第二标志点的拟合空间坐标;
步骤46,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
本发明还公开了一种激光雷达,包括存储单元、处理单元以及存储在该存储单元中供该处理单元运行的程序,所述处理单元运行所述程序时,实现前述方法。
本发明还公开了一种激光雷达参数自动标定的装置,该装置包括:
扫描单元,在标定场中设置第一标志物,该第一标志物具有第一标志点,利用激光雷达对该标定场进行激光扫描,获取扫描数据:
拟合单元,用于对该第一标志物的所在位置处的扫描数据进行拟合,获取该第一标志点的拟合空间坐标;
解算单元,用于利用该拟合空间坐标以及该第一标志点的测量空间坐标之间的误差,进行激光雷达参数的解算,利用解算出的激光雷达参数进行自动标定。
所述装置还包括:精度检验单元,用于将解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据,对该第二标志物的所在位置处的更新扫描数据进行拟合,获取该第二标志点的拟合空间坐标,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
本发明实现的技术效果在于,采用了圆锥体作为第一标志物,实现对激光雷达的自动标定,由于圆锥体具有弧面设计,故而没有明显的方向性要求,锥面上的激光点云可以全部贡献于对锥顶的拟合解算,同时,对激光点的密度要求更低,完整性要求低,可精确自动获取锥顶的空间坐标,无需人工参与,实现激光雷达设备的全自动和高精度标定。
另外,本发明可在激光雷达参数进行自动标定后,利用第二标志物,对标定进行精度检验,如果用户对于精度不满意,还可重新执行该自动标定的方法,直到激光雷达达到用户满意的精度等级,使得用户对于激光雷达的状况更加了解,还可满足用户对不同精度的需求。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域的普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他附图。
图1所示为本发明的激光雷达标定场示意图;
图2所示为本发明第一标志物的结构示意图;
图3所示为本发明第二标志物的结构示意图;
图4所示为本发明的激光雷达参数自动标定的一种方法流程图;
图5所示为本发明的第一标志物的扫描数据自动搜索示意图;
图6所示为本发明的激光雷达参数自动标定的另一方法流程图;
图7所示为本发明的激光雷达参数自动标定的另一方法流程图;
图8所示为本发明的激光雷达参数自动标定的另一方法流程图;
图9所示为本发明的第二标志物的扫描数据自动搜索示意图;
图10所示为本发明的一种激光雷达参数自动标定的装置的结构示意图。
具体实施方式
下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明的保护范围。
图1为本发明的一种激光雷达标定场示意图。
为了实现对激光雷达的自动标定,需对标定场1进行布置。标定场1通常设置在室内或室外固定场所。标定场1相向两墙面距离不小于10m,标定场1中360°均匀布设可视的第一标志物2与第二标志物3。标定场中央设置有激光雷达(图中未示),以对标定场进行全面扫描获得扫描数据,该扫描数据即为激光点云。
其中,第一标志物可为圆锥体,第二标志物可为球体,第一标志物具有第一标志点——圆锥顶点,第二标志物具有第二标志点——球心。第一标志物用于实现对激光雷达的自动标定,第二标志物用于实现对自动标定进行精度检验。
第一标志物可依据标定场1的空间尺寸均匀分布设置,数量可根据标定场1的空间尺寸和激光雷达设置位置相对各墙面的距离进行选择,较多控制点有利于提高激光雷达标定精度。第二标志物的布设数量可为6-8个,或者根据需求设置,不以此为限。对于所设置的所有标志物,预先测量其标志点的位置信息,得到测量空间坐标,同时,测量标志物的所处位置信息。
如图2所示为本发明第一标志物的结构示意图。第一标志物2的底边直径150-200mm,圆锥体高75-100mm,锥面平整,椎体对称精度优于1mm。
如图3所示为本发明第二标志物的结构示意图。第二标志物3的直径150-200mm,球面平整,球体对称精度优于1mm。
本发明公开了一种激光雷达参数自动标定的方法,如图4、6、7、8所示为激光雷达参数自动标定的方法流程图。
步骤10,在标定场中设置第一标志物,该第一标志物具有第一标志点,利用激光雷达对该标定场进行激光扫描,获取扫描数据。
激光雷达在初始状态下对标定场进行激光扫描,获取扫描数据,此时,激光雷达未进行激光雷达参数的设置。执行为本发明的方法,可自动实现对激光雷达参数d0、H、V、k1、k2、k3的设置,其中d0为测距误差,H为激光入射光线水平偏转,V为激光入射光线竖直偏转,k1,k2,k3为测角改正参数,是保证激光雷达实现准确测量的核心参数。
步骤20,对该第一标志物的所在位置处的扫描数据进行拟合,获取该第一标志点的拟合空间坐标。
该步骤20进一步包括:
步骤21,在该第一标志物的所在位置处随机提取N个点的扫描数据。
由于第一标志物的位置已经预先测量过,因此,激光雷达的处理单元可自动从扫描数据中锁定位于该第一标志物所在区域范围内的点。具体来说,如图5所示,激光雷达的处理单元锁定以圆锥体的所在底面以及椎体高度所构建的矩形体范围,从落在这一范围中的扫描数据中,提取任意N个点的数据。
步骤22,对圆锥面方程进行线性化,得到公式
其中,
利用步骤21中提取的N个点的数据,分别带入该公式(1),得到N组公式(1)的具体形式,进行最小二乘法,拟合计算该第一标志物的模型参数,得到第一标志物模型。
公式(1)中,n=1,2,3……N,N大于等于初始化模型参数所需的最小样本数,(x0、y0、z0)为该第一标志物模型中的第一标志点的三维坐标,(xn、yn、zn)为该N个点中之一的三维坐标,α为圆锥顶角的一半,(i,j,k)为圆锥方向单位法向量,Ln为第一标志物模型,F为第一标志物模型函数。
在这一步骤中,激光雷达的处理单元仅了解第一标志物为一圆锥体,对于该圆锥体的各种具体参数均作为未知。利用已知存在圆锥体的位置所得到的扫描数据,对公式(1)所对应的圆锥体模型进行训练,以期拟合得到较为准确的模型参数。
步骤23,将该N个点中与该第一标志物模型表面的距离位于预定的第一阈值范围内的点作为内点;
在步骤22中得到了x0、y0、z0、i、j、k、α的数值,从而得到了一个完整的公式(1),即一个完整的第一标志物模型。此时,计算该N个点各自与该第一标志物模型表面的距离,该距离处于预定的第一阈值范围内的点作为内点。事实上,距离越小,视为该第一标志物模型越准确,理想状态下,所有N个点均直接位于该第一标志物模型上,即距离为0。
接下来,在该第一标志物的所在位置处再次随机提取的多个点,迭代执行步骤22-23,直到内点的数量大于一第一门槛值d时,利用所有的内点再次执行步骤22,得到更新后的第一标志物模型。此时,可直接执行后续步骤26,也可以继续执行步骤24。
步骤24,判断更新后的第一标志物模型的精度是否比之前生成的第一标志物模型的精度高,如果是,保留该模型,继续执行步骤25,如果否,放弃当前第一标志物,选择下一第一标志物,执行步骤21。
在这一步骤中,通过该N个点各自与该更新后的第一标志物模型表面的距离来判断该精度。该N个点中,若小于一距离阈值的数量大于等于一数量阈值,视为精度更高,否则视为精度更低。如果根据内点所生成的更新后的第一标志物模型,其精度反而在下降,说明这一位置的圆椎体所得到的扫描数据的整体准确性低,为了保证自动标定的精确程度,则这一位置的扫描数据不作为后续解算激光雷达参数的基础,将其放弃,寻找下一第一标志物,重新开始进行圆锥体模型训练。
步骤25,判断迭代次数是否大于预定次数k,如果是,执行步骤26,如果否,执行步骤22。
步骤26,利用该更新后的第一标志物模型的圆锥顶点作为该第一标志点的拟合空间坐标。
通过不断迭代,可不断提高第一标志物模型的精确度,进而提高自动标定的准确度。
步骤30,利用该拟合空间坐标以及该第一标志点的测量空间坐标之间的误差,进行激光雷达参数的解算,利用解算出的激光雷达参数进行自动标定。
当对扫描数据中的所有第一标志物均执行前述步骤10、20后,执行步骤30。由于每个第一标志物的均具有第一标志点的拟合空间坐标以及第一标志点的测量空间坐标,则二者之差即为测量与拟合的误差。该步骤30针对多个第一标志物所得到的多组该误差,利用如下激光雷达参数解算模型进行激光雷达参数d0、H、V、k1、k2、k3的解算:
ΔX=Gx(d0,H,V,k1,k2,k3)
ΔY=Gy(d0,H,V,k1,k2,k3) (2)
ΔZ=Gz(d0,H,V,k1,k2,k3)
其中,ΔX为该拟合空间坐标的X轴数据与该测量空间坐标的X轴数据的差,ΔY为该拟合空间坐标的Y轴数据与该测量空间坐标的Y轴数据的差,ΔZ为该拟合空间坐标的Z轴数据与该测量空间坐标的Z轴数据的差,d0为测距误差,H为激光入射光线水平偏转,V为激光入射光线竖直偏转,k1,k2,k3为测角改正参数,Gx为X轴的激光雷达参数解算函数,Gy为Y轴的激光雷达参数解算函数,Gz为Z轴的激光雷达参数解算函数。
由于对多个第一标志物执行前述步骤10、20,故而目前得到多组(ΔX,ΔY,ΔZ),根据多组(ΔX,ΔY,ΔZ)带入公式(2)中,可得到公式(2)中的激光雷达参数d0、H、V、k1、k2、k3,则可据此激光雷达参数实现对激光雷达的自动标定。
在这一过程中,本发明采用了圆锥体作为第一标志物,实现对激光雷达的自动标定,由于圆锥体具有弧面设计,故而没有明显的方向性要求,锥面上的激光点云可以全部贡献于对锥顶的拟合解算,同时,对激光点的密度要求更低,对扫描的完整度要求低,可精确自动获取锥顶的空间坐标,无需人工参与,实现激光雷达设备的全自动和高精度标定。
在此基础上,本发明还可进一步实现对自动标定进行精度检验。
在步骤30以后,继续执行步骤40。
步骤40,将解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据,对该第二标志物的所在位置处的更新扫描数据进行拟合,获取该第二标志点的拟合空间坐标,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
该步骤40进一步包括:
步骤41,利用解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据。
激光雷达参数一经确定,激光雷达的处理单元将基于该激光雷达参数对扫描数据进行更新,使得扫描数据获得校正。
步骤42,在该第二标志物的所在位置处随机提取N个点的更新扫描数据。
这一步骤与步骤21同理,由于第二标志物的位置已经预先测量过,因此,激光雷达的处理单元可自动从更新扫描数据中锁定位于该第二标志物所在区域范围内的点。具体来说,如图9所示,激光雷达的处理单元锁定基于球体的直径所构建的矩形体范围,从落在这一范围中的更新扫描数据中,提取任意N个点的数据。
步骤43,根据公式(X-a)2+(Y-b)2+(Z-c)2=R2 (3)
计算该第二标志物的模型参数a、b、c、R,得到第二标志物模型,(a,b,c)为该第二标志物模型中的第二标志点的三维坐标,(X,Y,Z)为该N个点中之一的三维坐标,R为球面半径。
这一步骤与步骤22同理,利用步骤42中提取的N个点的数据,分别带入该公式(3),得到N组公式(3)的具体形式,进行最小二乘法解算,拟合计算该第二标志物的模型参数,得到第二标志物模型。
步骤44,将该N个点中与该第二标志物模型表面的距离位于预定的第二阈值范围内的点作为内点。
这一步骤与步骤23同理。将在该第二标志物的所在位置处再次随机提取多个点,迭代执行步骤43-44,直到内点的数量大于一第二门槛值d’或者,内点的数量大于一第二门槛值d’且迭代次数大于k’时,利用所有的内点再次执行步骤43,得到更新后的第二标志物模型。
步骤45,利用该更新后的第二标志物模型的球心作为该第二标志点的拟合空间坐标。
步骤46,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
该步骤46中,可根据一个第二标志物的误差进行精度检验,也可根据多个该第二标志物执行步骤41-46后得到的多组误差进行精度检验。
精度检验的规则可根据需求进行规定,误差越小,精度越高。可根据该精度检验的结果,输出一精度报告,以提升用户的体验。
可见,通过本发明的上述方法,可在激光雷达参数进行自动标定后,利用第二标志物,对标定进行自动精度检验,如果用户对于精度不满意,还可重新执行该自动标定的方法,直到激光雷达达到用户满意的精度等级,使得用户对于激光雷达的状况更加了解,还可满足用户对不同精度的需求。
本发明还公开了一种激光雷达,包括存储单元、处理单元以及存储在该存储单元中供该处理单元运行的程序,所述处理单元运行所述程序时,实现本发明前述的激光雷达参数自动标定的方法。
本发明还公开了一种激光雷达参数自动标定的装置,如图10所示,该装置100包括:
扫描单元101,在标定场中设置第一标志物,该第一标志物具有第一标志点,利用激光雷达对该标定场进行激光扫描,获取扫描数据。
拟合单元102,用于对该第一标志物的所在位置处的扫描数据进行拟合,获取该第一标志点的拟合空间坐标。
解算单元103,用于利用该拟合空间坐标以及该第一标志点的测量空间坐标之间的误差,进行激光雷达参数的解算,利用解算出的激光雷达参数进行自动标定。
在更进一步的实施例中,该装置100还包括:
精度检验单元104,用于将解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据,对该第二标志物的所在位置处的更新扫描数据进行拟合,获取该第二标志点的拟合空间坐标,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
综上所述,本发明所提供的方法可以用于测绘、工业等领域的三维空间信息采集,提高激光雷达设备标定的效率和精度。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明披露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求书的保护范围为准。

Claims (10)

1.一种激光雷达参数自动标定的方法,其特征在于,该方法包括:
步骤10,在标定场中设置第一标志物,该第一标志物具有第一标志点,利用激光雷达对该标定场进行激光扫描,获取扫描数据;
步骤20,对该第一标志物的所在位置处的扫描数据进行拟合,获取该第一标志点的拟合空间坐标;
步骤30,利用该拟合空间坐标以及该第一标志点的测量空间坐标之间的误差,进行激光雷达参数的解算,利用解算出的激光雷达参数进行自动标定。
2.如权利要求1所述的方法,其特征在于,标定场中还设置有第二标志物,该第二标志物具有第二标志点,步骤30之后还包括:
步骤40,将解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据,对该第二标志物的所在位置处的更新扫描数据进行拟合,获取该第二标志点的拟合空间坐标,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
3.如权利要求1所述的方法,其特征在于,第一标志物为圆锥体,该第一标志点为圆锥顶点。
4.如权利要求3所述的方法,其特征在于,该步骤20进一步包括:
步骤21,在该第一标志物的所在位置处随机提取N个点的扫描数据;
步骤22,根据公式
<mrow> <msub> <mi>L</mi> <mi>n</mi> </msub> <mo>=</mo> <mi>F</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>,</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>,</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>,</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>,</mo> <mi>k</mi> <mo>,</mo> <mi>&amp;alpha;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>n</mi> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> <mi>i</mi> <mo>+</mo> <mo>(</mo> <msub> <mi>y</mi> <mi>n</mi> </msub> <mo>-</mo> <msub> <mi>y</mi> <mi>o</mi> </msub> <mo>)</mo> <mi>j</mi> <mo>+</mo> <mo>(</mo> <msub> <mi>z</mi> <mi>n</mi> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> <mi>k</mi> </mrow> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>n</mi> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>n</mi> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mi>n</mi> </msub> <mo>-</mo> <msub> <mi>z</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mo>-</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;alpha;</mi> </mrow>
进行最小二乘法解算,计算该第一标志物的模型参数,得到第一标志物模型,n=1,2,3……N,N大于等于初始化模型参数所需的最小样本数,(x0、y0、z0)为该第一标志物模型中的第一标志点的三维坐标,(xn、yn、zn)为该N个点中之一的三维坐标,α为圆锥顶角的一半,(i,j,k)为圆锥方向单位法向量,Ln为第一标志物模型,F为第一标志物模型函数;
步骤23,将该N个点中与该第一标志物模型表面的距离位于预定的第一阈值范围内的点作为内点;
在该第一标志物的所在位置处再次随机提取多个点,迭代执行步骤22-23,直到内点的数量大于第一门槛值d时,利用所有的内点再次执行步骤22,得到更新后的第一标志物模型;
步骤24,利用该更新后的第一标志物模型的圆锥顶点作为该第一标志点的拟合空间坐标。
5.如权利要求4所述的方法,其特征在于,在得到该更新后的第一标志物模型的步骤之后,还包括:
分别计算从该第一标志物的所在位置处随机提取的多个点各自相对该更新后的第一标志物模型表面的距离,若小于一距离阈值的数量大于等于一数量阈值,执行步骤24,否则放弃该第一标志物。
6.如权利要求1所述的方法,其特征在于,该步骤30针对多个第一标志物所得到多组该误差,利用如下激光雷达参数解算模型进行激光雷达参数d0、H、V、k1、k2、k3的解算:
ΔX=Gx(d0,H,V,k1,k2,k3)
ΔY=Gy(d0,H,V,k1,k2,k3)
ΔZ=Gz(d0,H,V,k1,k2,k3)
其中,ΔX为该拟合空间坐标的X轴数据与该测量空间坐标的X轴数据的差,ΔY为该拟合空间坐标的Y轴数据与该测量空间坐标的Y轴数据的差,ΔZ为该拟合空间坐标的Z轴数据与该测量空间坐标的Z轴数据的差,d0为测距误差,H为激光入射光线水平偏转,V为激光入射光线竖直偏转,k1,k2,k3为测角改正参数,Gx为X轴的激光雷达参数解算函数,Gy为Y轴的激光雷达参数解算函数,Gz为Z轴的激光雷达参数解算函数。
7.如权利要求2所述的方法,其特征在于,该第二标志物为球体,该第二标志点为球心,该步骤40进一步包括:
步骤41,利用解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据;
步骤42,在该第二标志物的所在位置处随机提取N个点的更新扫描数据;
步骤43,根据公式(X-a)2+(Y-b)2+(Z-c)2=R2,进行最小二乘法解算,计算该第二标志物的模型参数a、b、c、R,得到第二标志物模型,(a,b,c)为该第二标志物模型中的第二标志点的三维坐标,(X,Y,Z)为该N个点中之一的三维坐标,R为球面半径;
步骤44,将该N个点中与该第二标志物模型表面的距离位于预定的第二阈值范围内的点作为内点;
在该第二标志物的所在位置处再次随机提取多个点,迭代执行步骤43-44,直到内点的数量大于第二门槛值时,利用所有的内点再次执行步骤43,得到更新后的第二标志物模型;
步骤45,利用该更新后的第二标志物模型的球心作为该第二标志点的拟合空间坐标;
步骤46,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
8.一种激光雷达,其特征在于,包括存储单元、处理单元以及存储在该存储单元中供该处理单元运行的程序,所述处理单元运行所述程序时,实现如权利要求1-7中任一所述的方法。
9.一种激光雷达参数自动标定的装置,其特征在于,该装置包括:
扫描单元,在标定场中设置第一标志物,该第一标志物具有第一标志点,利用激光雷达对该标定场进行激光扫描,获取扫描数据:
拟合单元,用于对该第一标志物的所在位置处的扫描数据进行拟合,获取该第一标志点的拟合空间坐标;
解算单元,用于利用该拟合空间坐标以及该第一标志点的测量空间坐标之间的误差,进行激光雷达参数的解算,利用解算出的激光雷达参数进行自动标定。
10.如权利要求9所述的装置,其特征在于,还包括:
精度检验单元,用于将解算出的该激光雷达参数对该扫描数据进行更新,获得更新扫描数据,对该第二标志物的所在位置处的更新扫描数据进行拟合,获取该第二标志点的拟合空间坐标,根据该第二标志点的拟合空间坐标与该第二标志点的测量空间坐标之间的误差,获得对该激光雷达参数的自动标定的精度检验结果。
CN201710515747.4A 2017-06-29 2017-06-29 一种激光雷达参数自动标定的方法、装置及激光雷达 Active CN107179534B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710515747.4A CN107179534B (zh) 2017-06-29 2017-06-29 一种激光雷达参数自动标定的方法、装置及激光雷达

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710515747.4A CN107179534B (zh) 2017-06-29 2017-06-29 一种激光雷达参数自动标定的方法、装置及激光雷达

Publications (2)

Publication Number Publication Date
CN107179534A true CN107179534A (zh) 2017-09-19
CN107179534B CN107179534B (zh) 2020-05-01

Family

ID=59844669

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710515747.4A Active CN107179534B (zh) 2017-06-29 2017-06-29 一种激光雷达参数自动标定的方法、装置及激光雷达

Country Status (1)

Country Link
CN (1) CN107179534B (zh)

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107976683A (zh) * 2017-11-24 2018-05-01 中国人民解放军63653部队 一种用激光雷达实时测量艇库内飞艇顶部离地高度的方法
CN107993263A (zh) * 2017-10-27 2018-05-04 深圳市易成自动驾驶技术有限公司 环视系统自动标定方法、汽车、标定装置及存储介质
CN108469617A (zh) * 2018-03-16 2018-08-31 浙江华领科技有限公司 基于单线激光扫描装置的激光测距方法和系统
CN109143207A (zh) * 2018-09-06 2019-01-04 百度在线网络技术(北京)有限公司 激光雷达内参精度验证方法、装置、设备及介质
CN109343036A (zh) * 2018-09-06 2019-02-15 北京理工大学 一种三维固态面阵激光雷达标定装置及方法
CN109375195A (zh) * 2018-11-22 2019-02-22 中国人民解放军军事科学院国防科技创新研究院 一种基于正交法向量的多线激光雷达外参数快速标定方法
CN109489553A (zh) * 2018-12-27 2019-03-19 中国科学院长春光学精密机械与物理研究所 一种空间标志点库的生成方法、装置、设备及存储介质
CN109597097A (zh) * 2018-12-06 2019-04-09 北京主线科技有限公司 基于多线激光的扫描式障碍物检测方法
CN109725303A (zh) * 2018-12-04 2019-05-07 北京万集科技股份有限公司 坐标系的修正方法及装置、存储介质
CN110132130A (zh) * 2019-03-05 2019-08-16 上海宾通智能科技有限公司 激光雷达位置标定方法、系统及其数据处理方法、系统
CN111765902A (zh) * 2020-06-18 2020-10-13 山东科技大学 一种基于多棱锥标靶的激光点云精度评估方法
CN112558027A (zh) * 2020-12-16 2021-03-26 深圳优地科技有限公司 雷达校验方法、装置、设备及存储介质
CN112748421A (zh) * 2019-10-30 2021-05-04 陕西汽车集团有限责任公司 一种基于直行路段自动驾驶的激光雷达校准方法
CN113109791A (zh) * 2021-03-15 2021-07-13 上海交通大学 一种车载激光雷达标定结果评价系统及方法
CN113359105A (zh) * 2021-06-15 2021-09-07 武汉米佳信息技术有限公司 一种基于二维激光雷达生成三维点云数据的方法及系统
CN113376617A (zh) * 2020-02-25 2021-09-10 北京京东乾石科技有限公司 雷达标定结果准确性的评价方法、装置、存储介质及系统
CN113608170A (zh) * 2021-07-07 2021-11-05 云鲸智能(深圳)有限公司 雷达标定方法、雷达、机器人、介质及计算机程序产品

Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1986153A8 (en) * 2007-04-23 2008-12-24 Mitsubishi Electric Corporation Method and system for determining objects poses from range images
CN101655344A (zh) * 2008-08-18 2010-02-24 北京航天计量测试技术研究所 一种电子经纬仪空间坐标测量系统的校准方法
CN101826129A (zh) * 2010-04-17 2010-09-08 中山大学 基于增强现实的虚拟测量原理及方法
CN102364299A (zh) * 2011-08-30 2012-02-29 刘桂华 一种多个结构光投影三维型面测量头的标定技术
CN103412302A (zh) * 2013-08-29 2013-11-27 西安电子科技大学 基于先验知识的多载频miso雷达目标定位方法
CN103792519A (zh) * 2014-01-13 2014-05-14 中国科学院空间科学与应用研究中心 一种基于有源定标器的星载雷达时钟漂移在轨校正方法
CN104142157A (zh) * 2013-05-06 2014-11-12 北京四维图新科技股份有限公司 一种标定方法、装置及设备
CN104483664A (zh) * 2015-01-05 2015-04-01 中国科学院光电研究院 单线阵激光雷达设备中心标定的方法
CN104808194A (zh) * 2015-05-07 2015-07-29 中国科学院合肥物质科学研究院 一种纯转动拉曼激光雷达系统常数的标定方法
CN105203023A (zh) * 2015-07-10 2015-12-30 中国人民解放军信息工程大学 一种车载三维激光扫描系统安置参数的一站式标定方法
CN105445708A (zh) * 2015-11-11 2016-03-30 西安电子科技大学 一种极化合成孔径雷达的定标方法
CN105842679A (zh) * 2016-04-22 2016-08-10 中国科学院上海技术物理研究所 一种国产卫星激光高度计在轨几何标定方法及系统
CN106501783A (zh) * 2016-09-22 2017-03-15 西安空间无线电技术研究所 一种交会对接微波雷达测角性能系统误差标定系统及方法
CN106556414A (zh) * 2016-11-24 2017-04-05 北京北科天绘科技有限公司 一种激光扫描仪的自动数字定向方法
US20170128260A1 (en) * 2004-03-24 2017-05-11 Amo Manufacturing Usa, Llc Calibrating laser beam position and shape using an image capture device
CN106872963A (zh) * 2017-03-31 2017-06-20 厦门大学 一种多组多线激光雷达的自动标定算法
CN106885531A (zh) * 2017-04-20 2017-06-23 河北科技大学 基于二维激光雷达的车斗形容器三维扫描系统标定方法

Patent Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170128260A1 (en) * 2004-03-24 2017-05-11 Amo Manufacturing Usa, Llc Calibrating laser beam position and shape using an image capture device
EP1986153A8 (en) * 2007-04-23 2008-12-24 Mitsubishi Electric Corporation Method and system for determining objects poses from range images
CN101655344A (zh) * 2008-08-18 2010-02-24 北京航天计量测试技术研究所 一种电子经纬仪空间坐标测量系统的校准方法
CN101826129A (zh) * 2010-04-17 2010-09-08 中山大学 基于增强现实的虚拟测量原理及方法
CN102364299A (zh) * 2011-08-30 2012-02-29 刘桂华 一种多个结构光投影三维型面测量头的标定技术
CN104142157A (zh) * 2013-05-06 2014-11-12 北京四维图新科技股份有限公司 一种标定方法、装置及设备
CN103412302A (zh) * 2013-08-29 2013-11-27 西安电子科技大学 基于先验知识的多载频miso雷达目标定位方法
CN103792519A (zh) * 2014-01-13 2014-05-14 中国科学院空间科学与应用研究中心 一种基于有源定标器的星载雷达时钟漂移在轨校正方法
CN104483664A (zh) * 2015-01-05 2015-04-01 中国科学院光电研究院 单线阵激光雷达设备中心标定的方法
CN104808194A (zh) * 2015-05-07 2015-07-29 中国科学院合肥物质科学研究院 一种纯转动拉曼激光雷达系统常数的标定方法
CN105203023A (zh) * 2015-07-10 2015-12-30 中国人民解放军信息工程大学 一种车载三维激光扫描系统安置参数的一站式标定方法
CN105445708A (zh) * 2015-11-11 2016-03-30 西安电子科技大学 一种极化合成孔径雷达的定标方法
CN105842679A (zh) * 2016-04-22 2016-08-10 中国科学院上海技术物理研究所 一种国产卫星激光高度计在轨几何标定方法及系统
CN106501783A (zh) * 2016-09-22 2017-03-15 西安空间无线电技术研究所 一种交会对接微波雷达测角性能系统误差标定系统及方法
CN106556414A (zh) * 2016-11-24 2017-04-05 北京北科天绘科技有限公司 一种激光扫描仪的自动数字定向方法
CN106872963A (zh) * 2017-03-31 2017-06-20 厦门大学 一种多组多线激光雷达的自动标定算法
CN106885531A (zh) * 2017-04-20 2017-06-23 河北科技大学 基于二维激光雷达的车斗形容器三维扫描系统标定方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
CHAO GAO等: "On-line calibration of multiple LIDARs on a mobile vehicle platform", 《IEEE INTERNATIONAL CONFERENCE ON ROBOTICS&AUTOMATION》 *
章大勇等: "机载激光雷达系统标定方法", 《光学精密工程》 *

Cited By (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107993263A (zh) * 2017-10-27 2018-05-04 深圳市易成自动驾驶技术有限公司 环视系统自动标定方法、汽车、标定装置及存储介质
CN107993263B (zh) * 2017-10-27 2021-07-06 深圳市易成自动驾驶技术有限公司 环视系统自动标定方法、汽车、标定装置及存储介质
CN107976683A (zh) * 2017-11-24 2018-05-01 中国人民解放军63653部队 一种用激光雷达实时测量艇库内飞艇顶部离地高度的方法
CN107976683B (zh) * 2017-11-24 2021-09-03 中国人民解放军63653部队 一种用激光雷达实时测量艇库内飞艇顶部离地高度的方法
CN108469617B (zh) * 2018-03-16 2020-04-03 浙江华领科技有限公司 基于单线激光扫描装置的激光测距方法和系统
CN108469617A (zh) * 2018-03-16 2018-08-31 浙江华领科技有限公司 基于单线激光扫描装置的激光测距方法和系统
CN109143207B (zh) * 2018-09-06 2020-11-10 百度在线网络技术(北京)有限公司 激光雷达内参精度验证方法、装置、设备及介质
US11506769B2 (en) 2018-09-06 2022-11-22 Apollo Intelligent Driving Technology (Beijing) Co., Ltd. Method and device for detecting precision of internal parameter of laser radar
CN109343036A (zh) * 2018-09-06 2019-02-15 北京理工大学 一种三维固态面阵激光雷达标定装置及方法
CN109143207A (zh) * 2018-09-06 2019-01-04 百度在线网络技术(北京)有限公司 激光雷达内参精度验证方法、装置、设备及介质
CN109375195A (zh) * 2018-11-22 2019-02-22 中国人民解放军军事科学院国防科技创新研究院 一种基于正交法向量的多线激光雷达外参数快速标定方法
CN109725303A (zh) * 2018-12-04 2019-05-07 北京万集科技股份有限公司 坐标系的修正方法及装置、存储介质
CN109725303B (zh) * 2018-12-04 2021-07-02 北京万集科技股份有限公司 坐标系的修正方法及装置、存储介质
CN109597097A (zh) * 2018-12-06 2019-04-09 北京主线科技有限公司 基于多线激光的扫描式障碍物检测方法
CN109597097B (zh) * 2018-12-06 2023-04-18 北京主线科技有限公司 基于多线激光的扫描式障碍物检测方法
CN109489553A (zh) * 2018-12-27 2019-03-19 中国科学院长春光学精密机械与物理研究所 一种空间标志点库的生成方法、装置、设备及存储介质
CN110132130A (zh) * 2019-03-05 2019-08-16 上海宾通智能科技有限公司 激光雷达位置标定方法、系统及其数据处理方法、系统
CN112748421A (zh) * 2019-10-30 2021-05-04 陕西汽车集团有限责任公司 一种基于直行路段自动驾驶的激光雷达校准方法
CN112748421B (zh) * 2019-10-30 2023-09-08 陕西汽车集团股份有限公司 一种基于直行路段自动驾驶的激光雷达校准方法
CN113376617A (zh) * 2020-02-25 2021-09-10 北京京东乾石科技有限公司 雷达标定结果准确性的评价方法、装置、存储介质及系统
CN113376617B (zh) * 2020-02-25 2024-04-05 北京京东乾石科技有限公司 雷达标定结果准确性的评价方法、装置、存储介质及系统
CN111765902A (zh) * 2020-06-18 2020-10-13 山东科技大学 一种基于多棱锥标靶的激光点云精度评估方法
CN112558027A (zh) * 2020-12-16 2021-03-26 深圳优地科技有限公司 雷达校验方法、装置、设备及存储介质
CN112558027B (zh) * 2020-12-16 2024-03-08 深圳优地科技有限公司 雷达校验方法、装置、设备及存储介质
CN113109791A (zh) * 2021-03-15 2021-07-13 上海交通大学 一种车载激光雷达标定结果评价系统及方法
CN113359105A (zh) * 2021-06-15 2021-09-07 武汉米佳信息技术有限公司 一种基于二维激光雷达生成三维点云数据的方法及系统
CN113608170A (zh) * 2021-07-07 2021-11-05 云鲸智能(深圳)有限公司 雷达标定方法、雷达、机器人、介质及计算机程序产品
CN113608170B (zh) * 2021-07-07 2023-11-14 云鲸智能(深圳)有限公司 雷达标定方法、雷达、机器人、介质及计算机程序产品

Also Published As

Publication number Publication date
CN107179534B (zh) 2020-05-01

Similar Documents

Publication Publication Date Title
CN107179534B (zh) 一种激光雷达参数自动标定的方法、装置及激光雷达
CN104820217B (zh) 一种多法向平面的多元线阵探测成像激光雷达的检校方法
CN108413988B (zh) 机器人末端经纬仪坐标系快速标定方法
CN108225185A (zh) 一种车载扫描系统检校方法
CN104007444A (zh) 一种基于中心投影的地面激光雷达反射强度图像的生成方法
CN109754433B (zh) 一种标定图像采集方法、装置、设备及存储介质
JP6745169B2 (ja) レーザ計測システム及びレーザ計測方法
JP6073944B2 (ja) レーザ計測システム、反射ターゲット体及びレーザ計測方法
JP2016206178A (ja) レーザ計測方法、レーザ計測用標識、及び座標算出プログラム
CN113567964A (zh) 激光雷达自动测试方法及装置、系统
CN106405581A (zh) 卫星结构变形引起的多类型载荷间耦合指向精度评估方法
TWI718380B (zh) 一種利用點雲判斷岩石不連續面位態的方法
CN107421509B (zh) 一种网壳型结构连续倒塌的高速视频测量方法
CN104007432A (zh) 一种检查机载激光雷达平面精度的地标布设方法
CN110986784B (zh) 基准坐标获取方法及其用途
CN110068282B (zh) 一种基于摄影测量的起重机械主梁变形检测方法
KR20190086951A (ko) 레이저 관측 장비를 이용한 mms의 캘리브레이션을 위한 장치 및 방법
CN104764465A (zh) 一种遥感卫星地面分辨率的测量方法
CN116950148A (zh) 一种基坑工程水平位移控制平差方法、存储介质及设备
CN111047552A (zh) 三维挠度测量方法及相关产品
JP2018115894A (ja) 磁場マップ更新方法及び磁場マップ更新装置
CN109035335B (zh) 一种基于单目视觉的海底隧道渗水水位识别方法
CN108195402B (zh) 全站仪大倾角测量误差分析及改正方法
CN114087988B (zh) 一种单目单线结构光传感器的精度评价方法
CN110794385B (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