CN112654886A - 外参标定方法、装置、设备及存储介质 - Google Patents
外参标定方法、装置、设备及存储介质 Download PDFInfo
- Publication number
- CN112654886A CN112654886A CN202080004813.1A CN202080004813A CN112654886A CN 112654886 A CN112654886 A CN 112654886A CN 202080004813 A CN202080004813 A CN 202080004813A CN 112654886 A CN112654886 A CN 112654886A
- Authority
- CN
- China
- Prior art keywords
- plane
- calibration
- coordinate system
- determining
- equipment
- 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
- 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
-
- 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
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)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本申请提供了一种外参标定方法、装置、设备及存储介质,属于自动驾驶领域。本申请通过使用测量设备对第一设备进行测量,确定出测量设备与第一设备之间的坐标系转换关系,使用测量设备和第二设备分别至少一个标定平面进行测量,确定出至少一个标定平面在测量设备和第二设备的坐标系下分别映射的至少一个平面组,利用至少一个平面组确定测量设备与第二设备之间的坐标系转换关系。由于外参是通过确定出的平面组获得的,而不需要从点云数据中提取同名点,从而避免了同名点的提取过程对标定精度的影响,因此提高了标定精度。
Description
技术领域
本申请涉及自动驾驶领域,特别涉及一种外参标定方法、装置、设备及存储介质。
背景技术
在测绘、自动驾驶等领域中,经常需要将设备测量的数据从设备本身的坐标系转换至其他坐标系,为了实现坐标系的转换,需要确定不同设备的坐标系之间的对应关系,即标定不同设备之间的外参。
以待标定的设备是激光雷达为例,相关技术在标定激光雷达的过程中,会首先在三维空间(如一个房间)中,通过测量设备扫描整个房间,根据扫描结果,获取标定物在三维空间的坐标系下映射的点的点坐标;然后,在该三维空间中通过激光雷达扫描整个房间,得到点云数据,在点云数据中提取出标定物映射的点的点坐标;在得到两个点坐标后,根据同名点(即标定物在两个坐标系下分别映射的点)之间的匹配关系,确定出激光雷达的坐标系与三维空间的坐标系之间的对应关系。
以上方法在确定外参时,需要从点云数据中提取出标定物映射的点的点坐标,而由于激光雷达本身存在测距误差并且分辨率不够高,难以精确地提取出标定物映射的点的点坐标,因此这种方法的标定精度较差。
发明内容
本申请实施例提供了一种外参标定方法、装置、设备及存储介质,能够提高外参标定的精度。所述技术方案如下:
第一方面,提供了一种外参标定方法,在该方法中,根据测量设备对第一设备的测量数据,获取第一标定参数,所述第一标定参数用于表示所述测量设备与所述第一设备之间的坐标系转换关系;根据所述测量设备对至少一个标定平面的测量数据,确定所述至少一个标定平面在所述测量设备的坐标系下映射的至少一个第一平面;根据第二设备对所述至少一个标定平面的测量数据,确定所述至少一个标定平面在所述第二设备的坐标系下映射的至少一个第二平面;根据所述至少一个第一平面和所述至少一个第二平面,确定至少一个平面组,所述平面组包括第一平面和第二平面,所述平面组中的第一平面与第二平面对应;根据所述至少一个平面组,确定第二标定参数,所述第二标定参数用于表示所述测量设备与所述第二设备之间的坐标系转换关系;根据所述第一标定参数和所述第二标定参数,获取所述第二设备与所述第一设备之间的外参。
通过以上方法来获取外参标定时,由于外参是通过确定出的平面组获得的,不需要从点云数据中提取同名点,从而避免了同名点的提取过程对标定精度的影响,因此提高了标定精度。此外,该方法能够固化为计算机自动化执行的流程,避免了人工计算标定参数会带来的费时费力的问题,因此提高了标定效率。
可选地,所述根据所述至少一个平面组,确定第二标定参数,包括:根据所述至少一个平面组,所述平面组中的第一平面和第二平面满足匹配条件,确定第二标定参数。
可选地,所述平面组中的第一平面和第二平面满足匹配条件,包括:所述平面组中的第一平面和第二平面之间的法向量夹角最小。
可选地,所述第二标定参数包括旋转矩阵,所述根据所述至少一个平面组,所述平面组中的第一平面和第二平面之间的法向量夹角最小,确定第二标定参数,包括:根据所述至少一个平面组和第一优化函数,确定所述旋转矩阵,所述旋转矩阵使得所述第一优化函数的取值为最小值。
通过上述可选方式,由于构造了构造第一优化函数,利用多次标定数据和第一优化函数,使用优化方法自动地求取旋转矩阵,一方面,旋转矩阵的解算过程能够由外参标定设备自动化完成,而无需人工干预,从而提升标定效率,也避免人工干预带来的误差。另一方面,可以通过多次标定数据,自动地求取旋转矩阵,降低单次标定带来的误差。
可选地,所述平面组中的第一平面和第二平面满足匹配条件,包括:所述平面组中的第一平面和第二平面之间的距离最小。
通过采用上述可选方式,由于利用平面匹配关系求解设备之间的外参,免去了选取同名点的步骤,获得更高的标定精度。
可选地,所述第二标定参数包括平移矩阵,所述根据所述至少一个平面组,所述平面组中的第一平面和第二平面之间的距离最小,确定第二标定参数,包括:根据所述至少一个平面组和第二优化函数,确定所述平移矩阵,所述平移矩阵使得所述第二优化函数的取值为最小值。
通过上述可选方式,由于构造了第二优化函数,利用多次标定数据和第二优化函数,使用优化方法自动地求取平移矩阵,一方面,平移矩阵的解算过程能够由外参标定设备自动化完成,而无需人工干预,从而提升标定效率,也避免人工干预带来的误差。另一方面,可以通过多次标定数据,自动地求取平移矩阵,降低单次标定带来的误差。
可选地,所述第二标定参数包括平移矩阵,所述根据所述至少一个平面组,确定第二标定参数,包括:使用所述旋转矩阵和初始平移矩阵,对第一平面上的点进行旋转变换和平移变换,得到所述点的投影点;根据所述至少一个平面组,确定使得所述投影点和所述第二平面之间的距离最小的初始平移矩阵,作为所述平移矩阵。
通过上述可选方式,考虑到即使第一平面和第二平面之间的法向量夹角最小,也可能出现第一平面和第二平面并非完全平行,而是第一平面和第二平面之间相交的情况,导致难以直接计算出第一平面和第二平面之间的距离,进而导致难以根据平面之间的距离确定平移矩阵。而通过上述方式,将两个面之间的距离计算转换为点和平面之间的距离计算,由于第一平面和第二平面平行或非平行的情况下,投影点和第二平面之间的距离都是容易求解的,从而保证确定平移矩阵的方法的应用范围更广泛,提升了实用性。
可选地,所述根据测量设备对第一设备的测量数据,获取第一标定参数,包括:根据所述第一设备上的标志点在所述第一设备的坐标系下的坐标值和所述测量设备测量得到的所述标志点在所述测量设备的坐标系下的坐标值,获取所述第一标定参数。
在第一设备不支持观测功能的情况下,会存在难以获得第一设备的坐标系的技术问题。而通过上述可选方式,由于使用测量设备观测第一设备上的标志点,来推算出第一设备的坐标系,提供了一种通过被动观测获取第一设备的坐标系的方式,有助于提高获得的第一设备的坐标系(即第一标定参数)的精度。
可选地,所述测量设备为全站仪、激光扫描仪或摄影测量系统,所述标定平面为标定板或墙,所述第一设备为惯导设备、车辆或第一激光雷达,所述第二设备为第二激光雷达、毫米波或相机。
第二方面,提供了一种外参标定装置,该外参标定装置包括:
获取模块,用于根据测量设备对第一设备的测量数据,获取第一标定参数,所述第一标定参数用于表示所述测量设备与所述第一设备之间的坐标系转换关系;
确定模块,用于根据所述测量设备对至少一个标定平面的测量数据,确定所述至少一个标定平面在所述测量设备的坐标系下映射的至少一个第一平面;
确定模块,用于根据第二设备对所述至少一个标定平面的测量数据,确定所述至少一个标定平面在所述第二设备的坐标系下映射的至少一个第二平面;
确定模块,用于根据所述至少一个第一平面和所述至少一个第二平面,确定至少一个平面组,所述平面组包括第一平面和第二平面,所述平面组中的第一平面与第二平面对应;
确定模块,用于根据所述至少一个平面组,确定第二标定参数,所述第二标定参数用于表示所述测量设备与所述第二设备之间的坐标系转换关系;
所述获取模块,还用于根据所述第一标定参数和所述第二标定参数,获取所述第二设备与所述第一设备之间的外参。
其中,该外参标定装置是有计算能力的装置,例如,该外参标定装置是计算设备、处理器、芯片、个人计算机等。
可选地,所述确定模块,用于根据所述至少一个平面组,所述平面组中的第一平面和第二平面满足匹配条件,确定第二标定参数。
可选地,所述平面组中的第一平面和第二平面满足匹配条件,包括:所述平面组中的第一平面和第二平面之间的法向量夹角最小。
可选地,所述第二标定参数包括旋转矩阵,所述确定模块,用于根据所述至少一个平面组和第一优化函数,确定所述旋转矩阵,所述旋转矩阵使得所述第一优化函数的取值为最小值。
可选地,所述平面组中的第一平面和第二平面满足匹配条件,包括:所述平面组中的第一平面和第二平面之间的距离最小。
可选地,所述第二标定参数包括平移矩阵,所述确定模块,用于根据所述至少一个平面组和第二优化函数,确定所述平移矩阵,所述平移矩阵使得所述第二优化函数的取值为最小值。
可选地,所述第二标定参数包括平移矩阵,所述确定模块,用于使用所述旋转矩阵和初始平移矩阵,对第一平面上的点进行旋转变换和平移变换,得到所述点的投影点;根据所述至少一个平面组,确定使得所述投影点和所述第二平面之间的距离最小的初始平移矩阵,作为所述平移矩阵。
可选地,所述获取模块,用于根据所述第一设备上的标志点在所述第一设备的坐标系下的坐标值和所述测量设备测量得到的所述标志点在所述测量设备的坐标系下的坐标值,获取所述第一标定参数。
可选地,所述测量设备为全站仪、激光扫描仪或摄影测量系统,所述标定平面为标定板或墙,所述第一设备为惯导设备、车辆或第一激光雷达,所述第二设备为第二激光雷达、毫米波或相机。
第三方面,提供了一种外参标定设备,该外参标定设备包括处理器,该处理器用于执行指令,使得该外参标定设备执行上述第一方面或第一方面任一种可选方式所提供的外参标定方法。第三方面提供的外参标定设备的具体细节可参见上述第一方面或第一方面任一种可选方式,此处不再赘述。
第四方面,提供了一种计算机可读存储介质,该存储介质中存储有至少一条指令,该指令由处理器读取以使外参标定设备执行上述第一方面或第一方面任一种可选方式所提供的外参标定方法。
第五方面,提供了一种计算机程序产品,当该计算机程序产品在外参标定设备上运行时,使得外参标定设备执行上述第一方面或第一方面任一种可选方式所提供的外参标定方法。
第六方面,提供了一种芯片,当该芯片在外参标定设备上运行时,使得外参标定设备执行上述第一方面或第一方面任一种可选方式所提供的外参标定方法。
第七方面,提供了一种外参标定系统,该外参标定系统包括外参标定设备、测量设备、第一设备以及第二设备,该外参标定设备用于执行上述第一方面或第一方面任一种可选方式所述的方法。
附图说明
图1是本申请实施例提供的一种激光雷达的外参标定的应用场景的示意图;
图2是本申请实施例提供的一种高精地图采集系统的架构示意图;
图3是本申请实施例提供的一种高精地图采集系统中外参标定装置的示意图;
图4是本申请实施例提供的一种外参标定装置的装置名称、规格参数和参考图的示意图;
图5是本申请实施例提供的一种外参标定方法300的流程图;
图6是本申请实施例提供的一种GNSS/IMU设备的坐标系的示意图;
图7是本申请实施例提供的一种外参标定方法400的流程图;
图8是本申请实施例提供的一种外参标定装置500的结构示意图;
图9是本申请实施例提供的一种外参标定设备600的结构示意图。
具体实施方式
为使本申请的目的、技术方案和优点更加清楚,下面将结合附图对本申请实施方式作进一步地详细描述。
为了便于理解,下面先对本申请实施例涉及的一些术语相关概念进行介绍。
标定是一种设备参数的获得过程,标定的目的是为了确定设备的一些参数的值。标定包括内参标定和外参标定。
外参标定是指确定设备A与设备B之间的坐标系转换关系的过程。通过设备A与设备B之间的外参,能够将设备A的坐标系中的点经过旋转和平移后映射到设备B的坐标系中,或者反过来,将设备B的坐标系中的点经过旋转和平移后映射到设备A的坐标系中。例如,标定激光雷达(Light Detection and Ranging,LiDAR)与全球导航卫星系统(GlobalNavigation Satellite System,GNSS)/惯性测量单元(Inertial measurementunit,IMU)设备之间的外参是求取激光雷达的坐标系至GNSS/IMU设备的坐标系之间的位姿变换关系。两个设备之间的外参通常利用旋转矩阵和平移矩阵表示。
旋转矩阵表示设备A与设备B之间的坐标系的旋转变换关系。可选地,旋转矩阵是三行三列大小的矩阵,旋转矩阵包括3个自由度,这3个自由度分别对应于x轴、y轴和z轴,旋转矩阵表示绕x轴、y轴和z轴这三个轴的旋转变换关系。可选地,旋转矩阵通过以下矩阵RLI表示。
或者,为了简化表达,旋转矩阵通过一个四元数来表示,四元数例如记为qLI。四元数qLI例如为(w,x,y,z)。RLI和qLI是等同的,均表示旋转变换。
平移矩阵表示设备A与设备B之间的坐标系的平移变换关系。可选地,旋转矩阵是3*1大小的矩阵,旋转矩阵包括3个自由度,这3个自由度分别对应于x轴、y轴和z轴,平移矩阵表示x、y和z这三个轴方向的平移。例如,平移矩阵通过以下矩阵TLI表示。
TLI=[tx ty tz]T
本申请实施例提供的外参标定方法能够应用在激光雷达的外参标定场景。下面对激光雷达的外参标定场景进行简单的介绍。
激光雷达是一种新型传感器。激光雷达包括激光发射器和接收器。激光发射器产生并发射一束光脉冲,光脉冲打在物体上并反射回来,最终光脉冲被接收器所接收。接收器准确地测量光脉冲从发射到被反射回的传播时间。根据激光发射器的高度,激光扫描角度,准确地计算出每一个光斑相对于激光雷达中心的坐标。
由于激光雷达的测距精度可达几个厘米,测距精度较为精确,使得激光雷达被广泛应用于测绘、智能驾驶等领域。在应用过程中,经常需要将激光雷达所获取的点云信息,由激光雷达坐标系转换至其它坐标系。例如,在高精地图制作中,需要用到激光雷达扫描采集区域内的激光点云,以及定位定姿系统(如GNSS/IMU设备)所获取的位姿信息。参见附图1,需要进行激光雷达与GNSS/IMU设备的外参标定,即获取激光雷达坐标系与GNSS/IMU设备坐标系间的转换关系,以便利用激光雷达与GNSS/IMU设备之间的外参,将多帧激光点云结合每帧时刻的位姿信息,拼接成世界点云。
以上介绍了激光雷达的外参标定场景,以下对激光雷达的外参标定场景在具体应用中的情况举例说明,并介绍本申请提供的方法在该应用场景中的技术效果。
在一种可能的实现中,获取多传感器的安装数据,依据每个传感器的安装数据,计算出各传感器间的相对位置关系,从而计算出各传感器间的外参。传感器的安装数据的形式不限于设计图纸、计算机辅助技术(Computer Aided Design,CAD)图纸、三维模型等一切可量测数学模型。例如,根据激光雷达的设计图纸内的公式,计算出激光雷达坐标系的中心位置。同理地,计算出激光雷达之外的其他传感器的中心位置,然后计算出激光雷达与其他传感器在空间中的相对位置关系。
然而,当采用上述方式时,由于实际安装存在误差,实际安装不能够精确的按照设计图纸的要求进行,所以会引入安装误差。故只依赖设计图纸数据计算出的外参精度不够高。
在一种可能的实现中,在一个三维场景,如一个房间,通过高精度的三维测量设备,扫描获得整个房间内标志物(如墙角、柱子、以及其它标志物)的三维坐标。然后使用激光雷达扫描整个房间,提取出各标志物在激光雷达点云中的坐标,通过同名标志物的匹配关系,确定出激光雷达坐标系与三维空间坐标系的关系。
然而,当采用上述方式时,第一,难以实现不支持观测功能的传感器(如GNSS/IMU设备)与所诉三维场景间坐标系转换关系的建立。即无法进行GNSS/IMU设备与激光雷达、相机之间的外参标定。第二,使用匹配点的方式进行校准,需要在激光点云中提取与三维模型对应的点,而实际上激光雷达精度一般在±2厘米(cm),所以使用这种方式精度较差。第三,建立三维场景模型需要的设备十分昂贵,精度较高的设备价格在百万级别,所以使用这种方式成本过高。
在一种可能的实现中,根据所记录的多线激光雷达的高度和GNSS/IMU设备读取的多线激光雷达的姿态角度信息,确定多线激光雷达相对于参考平面的参考点,可视化显示上述参考点,根据所显示的参考点和与之对应的实际点云之间的偏差,调整GNSS/IMU设备与多线激光雷达之间的标定参数,当根据调整后的标定参数显示的偏差为零时,确定标定结束。
然而,当采用上述方式时,需要专业人员人工根据方案原理及可视化结果不断调整标定参数。因此,该方式的缺陷在于比较费时费力且需要专业人员操作,无法固化为流程;其次依赖人工,无法进行自动化,且精度依赖人眼观察结果。
在一种可能的实现中,使用多线激光雷达扫描一个平板;根据扫描的结果,提取平板边缘点,拟合平板边缘线;通过两条边缘线的交点,求取平板的角点,作为激光雷达坐标系下的已知点。
然而,当采用上述方式时,拟合边缘线是利用激光雷达扫描平板边缘得到的若干点(数量不超过线束数),其精度难以得到保证。并且,无法获取角点在GNSS/IMU设备坐标系下的准确坐标。例如,在使用全站仪的情况下,无法准确照准角点。
在激光雷达与GNSS/IMU设备之间的外参标定场景下,由于GNSS/IMU设备本身无法主动观测,所以无法间接获得其坐标系,必须通过其它参照物来获取GNSS/IMU设备的坐标系。其次,激光雷达本身存在测距误差,再加上其分辨率不够高,可能无法精确获得空间中某一点的位置。综上,导致了激光雷达与GNSS/IMU设备外参标定比较困难且精度不够高,无法满足高精度地图制图的需求。
本申请的一些实施例中,针对高精地图采集系统中激光雷达与GNSS/IMU设备这两个设备之间外参标定场景,提出一种高精度、自动化程度高的激光雷达外参标定方法。通过利用高精度三维测量设备(如全站仪)结合GNSS/IMU设备的机构尺寸参数,观测出GNSS/IMU设备的坐标系,并使用全站仪与激光雷达同时观测标定平面(如标定平板),利用拟合出的同名平面的匹配关系,构造匹配条件,分步求解旋转矩阵和平移矩阵。由于避免从激光点云中选取同名点,从而提高了标定精度。
下面介绍本申请实施例提供的系统架构。
参见附图2,本申请实施例提供了一种系统架构100。系统架构100是对高精地图采集系统的举例说明。其中,高精地图中的“高精度”包括两个方面的含义。一方面是指地图中的坐标精度更高,例如坐标的精度在厘米级。另一方面是指地图所含有的道路交通信息元素更丰富和细致,例如地图不仅包括道路,还包括道路形状、红绿灯等信息。
系统架构100包括激光雷达101、GNSS/IMU设备102、长焦相机103、短焦相机104、天线107和车辆105。
GNSS/IMU设备102与激光雷达101、长焦相机103和短焦相机104刚性连接固定。激光雷达101、GNSS/IMU设备102、天线107、长焦相机103、短焦相机104设置在基座106上,基座106设置在车辆105的车顶上。
在制作高精地图的过程中,激光雷达101用于扫描采集区域内的激光点云。GNSS/IMU设备102用于获取位姿信息。
参见附图3,本申请实施例提供了一种系统架构200。系统架构200是对高精地图采集系统的举例说明。例如,系统架构200适于应用在系统架构100中激光雷达101与GNSS/IMU设备102之间的外参标定场景。系统架构200包括激光雷达101、GNSS/IMU设备102、全站仪201、多个标定板和个人计算机(Personal Computer,PC),可选地,PC是其他具有处理能力的装置,例如是处理器、芯片等。其中PC在附图3中未示出。参见附图4,附图4是对系统架构200涉及的每个装置的装置名称、规格参数和参考图的举例说明。
可选地,全站仪201是激光全站仪。全站仪201的测距精度例如是0.1毫米(mm)。全站仪201设置在与GNSS/IMU设备102和标定板均通视的位置。
多个标定板包括标定板2021、标定板2022和标定板2023。标定板2021、标定板2022和标定板2023设置在不同的位置。标定板2021、标定板2022和标定板2023具有不同的姿态。可选地,标定板是珐琅标定板。可选地,标定板具有标定氧化铝镀层。可选地,标定板的规格是1.0米*1.0米,即宽度和高度各为1米。其中,氧化铝镀层的材质是高反材料,氧化铝镀层的漫反射程度较小。珐琅玻璃表面非常平整且不易产生形变。
GNSS/IMU设备102为待标定的惯导设备。可选地,GNSS/IMU设备102的外形是一个盒子。
可选地,激光雷达101是多线束的激光雷达101。激光雷达101设置在可观测标定板的位置。激光雷达101与GNSS/IMU设备102刚性连接固定。
PC中安装和运行有解算程序,该解算程序用于求解旋转矩阵和平移矩阵,从而确定出激光雷达101、GNSS/IMU设备102之间的外参。PC通过无线网络或有线网络与激光雷达101、GNSS/IMU设备102、全站仪201中的至少一者相连。
以上介绍了系统架构,以下通过方法300至方法400,示例性介绍基于上文提供的系统架构进行外参标定的方法流程。
参见附图5,附图5是本申请实施例提供的一种外参标定方法300的流程图。
方法300涉及的硬件装置包括测量设备、第一设备、第二设备、标定平面和外参标定设备。
可选地,测量设备是高精度三维测量设备。例如,测量设备为全站仪、激光扫描仪或摄影测量系统。
可选地,标定平面是任意具有平整表面的硬件装置。可选地,标定平面是激光无法穿透的平面。例如,标定平面为标定板或墙。其中,通过使用标定板,有助于得到较高的标定精度。
方法300用于第一设备与第二设备之间的外参标定。可选地,第一设备和第二设备是任意两个不同的设备。可选地,第一设备和第二设备是任意两个不同的传感器。可选地,第一设备和第二设备分别是传感器和非传感器,例如第一设备和第二设备分别是传感器和车体。可选地,第一设备和第二设备具有相同的设备类型。例如,第一设备和第二设备均是激光雷达,第一设备是第一激光雷达,第二设备是第二激光雷达。可选地,第一设备和第二设备具有不同的设备类型。例如,第一设备是惯导设备或车辆105,第二设备是激光雷达、毫米波或相机。例如,第一设备是激光雷达,第二设备是毫米波或相机。可选地,第一设备是不支持观测功能的设备。例如,第一设备是惯导设备,比如第一设备是GNSS/IMU设备。
可选地,方法300由系统架构200中的激光雷达101、全站仪201和PC交互执行。例如,方法300的S301由全站仪201预先执行,得到全站仪201对GNSS/IMU设备102测量得到的数据、全站仪201对标定板测量得到的数据,方法300的S305由激光雷达101预先执行,得到激光雷达101对标定板测量得到的数据。全站仪201和激光雷达101分别得到的数据作为PC的输入,并由PC执行S307至S312。系统架构200通过实施方法300,能够自动化地获得精确的激光雷达101与GNSS/IMU设备102间的外参,即获取激光雷达101坐标系与GNSS/IMU设备102坐标系间的转换关系。利用激光雷达101与GNSS/IMU设备102之间的外参,能够将多帧激光点云结合每帧时刻的位姿信息,拼接成世界点云。
示例性地,方法300包括S301至S312。
S301、测量设备对第一设备进行测量,得到对第一设备的测量数据。
在一些实施例中,第一设备上具有多个标志点,测量数据是第一设备上多个标志点中每个标志点在测量设备的坐标系下的坐标值。
标志点位于第一设备上已知坐标值的位置。换句话说,标志点在第一设备的坐标系下的坐标值是能够预先确定的。因此,利用同一个标志点在第一设备的坐标系下的坐标值和在测量设备的坐标系下的坐标值,能够确定测量设备与第一设备之间的坐标系转换关系。可选地,第一设备上标志点的数量是至少4个。可选地,第一设备上的多个标志点均匀分布在第一设备的表面上。可选地,在第一设备本身没有标志点的情况下,人工对第一设备上进行标记,将标记的点作为标志点。
例如,第一设备是GNSS/IMU设备,测量设备是全站仪,标定平面是标定板。预先在与GNSS/IMU设备以及标定板通视的位置架设全站仪,完成建站。在执行S301的过程中,全站仪观测GNSS/IMU设备上已知坐标的多个标志点,进行后方交会,得到对GNSS/IMU设备的测量数据。其中,该多个标志点的数量在4个以上。
S302、测量设备将对第一设备的测量数据传输至外参标定设备。
如何将测量数据传输至外参标定设备包括多种方式。可选地,将测量设备测量得到测量数据保存至存储设备中,外参标定设备从存储设备中读取测量数据,从而通过存储设备将测量数据传输至外参标定设备。该存储设备包括而不限于U盘或移动硬盘等。可选地,测量设备直接将对第一设备的测量数据传输至外参标定设备,例如,测量设备与外参标定设备建立无线网络连接,测量设备通过无线通信的方式,将测量数据传输至外参标定设备。又如,测量设备与外参标定设备通过线缆相连,测量设备将测量数据通过线缆传输至外参标定设备。
S303、测量设备对至少一个标定平面进行测量,得到测量数据。
测量设备对至少一个标定平面中的每个标定平面进行测量,得到每个标定平面对应的测量数据。可选地,每个标定平面上具有至少一个标志点,测量设备对每个标定平面中的每个标志点分别进行测量,得到测量数据。可选地,一个标定平面上具有至少九个标志点。可选地,一个标定平面上的所有标志点均匀分布在标定平面上,从而防止由于标定平面变形带来的误差。例如,测量设备是全站仪,标定平面是标定板,使用全站仪观测标定板上若干标志点,得到测量数据。
S304、测量设备将对至少一个标定平面的测量数据发送至外参标定设备。
S305、第二设备对至少一个标定平面进行测量,得到测量数据。
第二设备对至少一个标定平面中的每个标定平面进行测量,得到每个标定平面对应的测量数据。可选地,每个标定平面上具有至少一个标志点,第二设备对每个标定平面中的每个标志点分别进行测量,得到测量数据。例如,第二设备是激光雷达,标定平面是标定板,使用激光雷达观测标定板,保存点云数据,该点云数据是对第二设备得到的测量数据的举例说明。
在一些实施例中,S303和S305通过多次测量过程执行。例如,标定平面是标定板,在执行第i次测量时,先将标定板设置在位置i,使得标定板具有姿态i。然后,测量设备对位置i和姿态i的标定板进行测量,得到第i次测量的测量数据。第二设备对位置i和姿态i的标定板进行测量,得到第i次测量的测量数据。之后,在执行第(i+1)次测量时,将标定板的位置从位置i调整至位置i+1,将标定板的姿态从姿态i调整至姿态i+1。然后,测量设备对位置i+1和姿态i+1的标定板进行测量,得到第(i+1)次测量的测量数据。第二设备对位置i+1和姿态i+1的标定板进行测量,得到第(i+1)次测量的测量数据。依次类推,通过对标定板进行n次测量,得到n个平面组的数据。其中,i是正整数,i大于或等于1且小于或等于n。n是正整数,n大于或等于2。可选地,n大于或等于20。通过这种方式,由于对标定平面进行了重复观测,能够减少测量误差。
S306、第二设备将对至少一个标定平面的测量数据发送至外参标定设备。
S307、外参标定设备根据测量设备对第一设备的测量数据,获取第一标定参数。
第一标定参数用于表示测量设备与第一设备之间的坐标系转换关系。第一标定参数也称测量设备所观测出的第一设备的坐标系。具体地,第一标定参数包括旋转矩阵或者平移矩阵中的至少一项。该旋转矩阵表示从测量设备的坐标系至第一设备的坐标系的旋转变换关系。该平移矩阵表示从测量设备的坐标系至第一设备的坐标系的平移变换关系。例如,对于测量设备的坐标系中的点A而言,利用第一标定参数中的旋转矩阵对点A进行旋转变换,并利用第一标定参数中的平移矩阵对点A进行平移变换后,能够得到点A在第一设备的坐标系中的同名点。
如何确定第一标定参数包括多种实现方式。在一种可能的实现中,外参标定设备获取第一设备上的标志点在第一设备的坐标系下的坐标值,根据第一设备上的标志点在第一设备的坐标系下的坐标值和测量设备测量得到的标志点在测量设备的坐标系下的坐标值,获取第一标定参数。
例如,第一设备是GNSS/IMU设备,测量设备是全站仪,外参标定设备获取GNSS/IMU设备上的标志点在GNSS/IMU设备的坐标系下的坐标值,并计算出全站仪坐标系下测量出的标志点相对于GNSS/IMU设备坐标系的坐标值,从而得到全站仪的坐标系相对于GNSS/IMU设备的坐标系的转换关系。其中,请参见附图6,附图6是对GNSS/IMU设备的坐标系的举例说明。全站仪的坐标系相对于GNSS/IMU设备的坐标系的转换关系是对第一标定参数的举例说明。第一标定参数例如通过以下方程(1)中的RTI和TrI表示,RTI和TTI也称为全站仪观测出的GNSS/IMU设备的坐标系。
方程(1)的含义是CT中任意一点pT经过RTI进行旋转变换,并经过TTI平移变换后,能够得到pT在CI中的同名点pI。在方程(1)中,pT表示全站仪坐标系中的任意一点。RTI表示从全站仪至GNSS/IMU设备的旋转矩阵。TTI表示从全站仪至GNSS/IMU设备的平移矩阵。pI表示GNSS/IMU设备坐标系中的点。CT表示全站仪的坐标系,CI表示GNSS/IMU设备的坐标系。
为了简明起见,本实施例涉及的每个方程中,用下标“大写英文字母”表示数据对应的设备。具体地,用下标“T”来表示全站仪对应的数据,用下标“I”表示GNSS/IMU设备对应的数据,用下标“L”表示激光雷达对应的数据。例如,pT表示全站仪坐标系中的点,pL表示激光雷达坐标系中的点。此外,下标“W”表示世界。
为了简明起见,本实施例涉及的每个方程中,用下标“2个大写英文字母”表示数据是2个设备对应的数据。具体地,下标“TI”标识全站仪与GNSS/IMU设备之间的数据,下标“LT”表示全站仪与激光雷达之间的数据。例如,如上述方程(1)中,RTI表示从全站仪至GNSS/IMU设备的旋转矩阵。
本段对上述方式的技术效果进行介绍。在第一设备不支持观测功能的情况下,会存在难以获得第一设备的坐标系的技术问题。而上述方法中,通过使用测量设备观测第一设备上的标志点,来推算出第一设备的坐标系,提供了一种通过被动观测获取第一设备的坐标系的方式,有助于提高获得的第一设备的坐标系(即第一标定参数)的精度。例如,测量设备是全站仪,第一设备是GNSS/IMU设备。通过使用全站仪观测GNSS/IMU设备外表面上的标志点,结合GNSS/IMU设备机构尺寸参数(即GNSS/IMU设备上标志点在GNSS/IMU设备坐标系下的坐标值),推算出GNSS/IMU设备的坐标系,解决了GNSS/IMU设备的坐标系难以获取的问题。并且,由于全站仪的观测精度高,所以获取的GNSS/IMU设备的坐标系的精度也高。
S308、外参标定设备根据测量设备对至少一个标定平面的测量数据,确定至少一个标定平面在测量设备的坐标系下映射的至少一个第一平面。
第一平面是指标定平面在测量设备的坐标系下映射的平面。可选地,第一平面通过平面方程中的参数表示。可选地,外参标定设备确定的至少一个第一平面和至少一个标定平面是一一对应的。例如,外参标定设备确定的第i个第一平面是第i个标定平面在测量设备的坐标系下映射的平面。可选地,第一平面通过平面拟合的方式确定。平面拟合的方式例如是主成分分析(Principal Component Analysis,PCA)方法。
其中,PCA方法例如包括:将标定平面的点云的三维坐标进行中心化,求得协方差矩阵并对角化,求得三个特征值,最小特征值对应的特征向量就是标定平面的法向量。任意带入一点的坐标,并归一化即可得到第一平面的平面方程。
例如,标定平面是标定板,测量设备是全站仪,外参标定设备是PC。使用全站仪对标定板进行第i次测量后,PC通过平面拟合的方式,会计算出标定板在全站仪坐标系下空间平面的方程,如以下方程(2)所示。
ai X+bi Y+ci Z+1=0; 方程(2)
在方程(2)中,(ai,bi,ci)表示第i次测量时标定板在全站仪坐标系下映射的平面。i的取值是大于或等于1且小于或等于n。n是测量的次数。依次类推,使用全站仪对标定板进行n次测量后,会得到(a1,b1,c1)、(a2,b2,c2)……(ai,bi,ci)和(an,bn,cn)这n组数据,这n组数据表示n个第一平面。
S309、外参标定设备根据第二设备对至少一个标定平面的测量数据,确定至少一个标定平面在第二设备的坐标系下映射的至少一个第二平面。
第二平面是指标定平面在第二设备的坐标系下映射的平面。可选地,第二平面通过平面方程中的参数表示。可选地,外参标定设备确定的至少一个第二平面和至少一个标定平面是一一对应的。例如,外参标定设备确定的第i个第二平面是第i个标定平面在第二设备的坐标系下映射的平面。可选地,第二平面通过平面拟合的方式确定。平面拟合的方式例如是PCA方法。PCA方法请参见上述S308的介绍。
例如,标定平面是标定板,第二设备是激光雷达,外参标定设备是PC。使用激光雷达对标定板进行第i次测量后,得到点云数据。PC分割提取出点云数据中标定板的点云,通过平面拟合的方式,计算出标定板在激光雷达坐标系下空间平面的方程,如以下方程(3)所示。
Ai X+Bi Y+Ci Z+1=0;方程(3)
在方程(3)中,(Ai,Bi,Ci)表示第i次测量时标定板在激光雷达坐标系下映射的平面。i的取值是大于或等于1且小于或等于n。n是测量的次数。依次类推,使用激光雷达对标定板进行n次测量后,会得到(A1,B1,C1)、(A2,B2,C2)、......(Ai,Bi,Ci)、......(An,Bn,Cn)这n组数据,这n组数据表示n个第二平面。
S310、外参标定设备根据至少一个第一平面和至少一个第二平面,确定至少一个平面组。
一个平面组包括一个第一平面和一个第二平面。平面组中的第一平面与第二平面对应。例如,平面组中的第一平面和第二平面是同一个标定平面分别映射的两个平面。例如,平面组i包括第一平面i和第二平面i。其中,第一平面i是标定平面i在测量设备的坐标系下映射的平面。第二平面i是标定平面i在第二设备的坐标系下映射的平面。可选地,确定平面组i通过获得平面组i的数据实现,平面组i的数据包括(ai,bi,ci)和pi、(Ai,Bi,Ci)和Pi、平面的法向量以及平面中心点。其中,(ai,bi,ci)表示第i次测量得到的第一平面。pi表示第一设备(如GNSS/IMU设备)坐标系下平面上的一点。(Ai,Bi,Ci)表示第i次测量得到的第二平面。Pi表示pi对应的第二设备(如激光雷达)坐标系下平面上的一点。其中,平面组i是对至少一个平面组中的一个平面组的举例说明。
在一些实施例中,外参标定设备确定出的平面组的数量是多个。可选地,外参标定设备确定出的平面组的数量和测量标定平面的次数相等。例如,分别使用测量设备和第二设备对标定平面进行n次测量后,外参标定设备会确定出n个平面组。
S311、外参标定设备根据至少一个平面组,确定第二标定参数。
其中,第二标定参数用于表示测量设备与第二设备之间的坐标系转换关系。具体地,第二标定参数包括旋转矩阵或者平移矩阵中的至少一项。该旋转矩阵表示从测量设备的坐标系至第二设备的坐标系的旋转变换关系。该平移矩阵表示从测量设备的坐标系至第二设备的坐标系的平移变换关系。对于测量设备的坐标系中的点A而言,利用第二标定参数中的旋转矩阵对点A进行旋转变换,并利用第二标定参数中的平移矩阵对点A进行平移变换后,能够得到点A在第二设备的坐标系中的同名点。
例如,测量设备是全站仪,第二设备为激光雷达,第二标定参数用于表示全站仪与激光雷达之间的坐标系转换关系,第二标定参数可以通过以下方程(4)中的参数表示。
方程(4)的含义是,CL中任意一点pL经过RLT旋转变换并经过TLT平移变换后,能够得到pL在CT中的同名点pT。方程(4)中,pL表示激光雷达的坐标系中的任意一点。RLT表示全站仪与激光雷达之间的旋转矩阵,TLT表示全站仪与激光雷达之间的旋转矩阵。pT表示全站仪的坐标系中的点。CL表示激光雷达的坐标系。CT表示全站仪的坐标系。
在一些实施例中,外参标定设备利用平面匹配关系求解第二标定参数。其中,平面匹配关系是指同一个标定平面在测量设备和第二设备的坐标系下分别映射的两个平面之间的匹配关系,即,同一平面组中的第一平面和第二平面组之间的匹配关系。具体地,外参标定设备根据至少一个平面组,平面组中的第一平面和第二平面满足匹配条件,确定第二标定参数。其中,平面组中的第一平面和第二平面满足匹配条件,包括以下条件A和条件B。
条件A、平面组中的第一平面和第二平面之间的法向量夹角最小。例如,第一平面和第二平面平行或者近似平行。
条件B、平面组中的第一平面和第二平面之间的距离最小。例如,第一平面和第二平面之间的距离是0或接近0。换句话说,第一平面和第二平面是重合或近似重合的。
在一些实施例中,当外参标定设备通过平面拟合的方式,分别拟合出标定平面映射的第一平面和标定平面映射的第二平面后,求解使得第一平面和第二平面是同名平面的标定参数,作为第二标定参数。其中,同名平面是指两个坐标系下的同一个平面。第一平面和第二平面是同名平面是对第一平面和第二平面满足匹配条件的举例说明。
本段对利用平面匹配关系求解第二标定参数的效果进行介绍。在利用同名点进行匹配以求解标定参数的方式中,会由于选取的同名点准确性不高,出现影响标定精度的技术问题。例如,在第二设备是激光雷达的情况下,如果通过选取激光雷达中的同名点并利用点对匹配的方法求解标定参数,会由于激光雷达具有一定的测距误差导致标定精度不够高。而采用以上方式,通过进行平面拟合,并利用平面匹配关系求解激光雷达坐标系与GNSS/IMU设备坐标系间的转换关系,免去了选取激光雷达中的同名点的步骤,从而获得更高的标定精度。
在一些实施例中,第二标定参数通过优化的方法求解。例如,第二标定参数中的旋转矩阵和平移矩阵分别通过两个优化函数确定。优化函数也称代价函数或目标函数。为了区分描述,本实施例将用于确定旋转矩阵的优化函数称为第一优化函数,将用于确定平移矩阵的优化函数称为第二优化函数。
在一些实施例中,外参标定设备会根据至少一个平面组和第一优化函数,确定第二标定参数中的旋转矩阵,该旋转矩阵使得第一优化函数的取值为最小值。
第一优化函数用于根据初始旋转矩阵和至少一个平面组确定第一平面和第二平面之间的法向量夹角。第一优化函数的输入参数包括初始旋转矩阵和至少一个平面组,第一优化函数的取值用于表示平面组中第一平面和第二平面之间的法向量夹角的大小。
例如,第一优化函数的表达式如下所示。
f1=min(1-RLT*(A,B,C)*(a,b,c))||min(1+RLT*((A,B,C)))
其中,f1表示第一优化函数。f1的含义为两个匹配平面之间的法向量夹角最小。符号“||”的含义是或者。(1-RLT*(A,B,C)*(a,b,c))和(1+RLT*((A,B,C)))均表示平面组中的第一平面和第二平面之间的法向量夹角,具体是指通过(A,B,C)表示的第二平面和通过(a,b,c)表示的第一平面之间的法向量夹角。
如何利用第一优化函数确定旋转矩阵包括多种方式。在一种可能的实现中,第二标定参数中的旋转矩阵是在第一优化函数中的初始旋转矩阵的基础上调整得到的。例如,确定第一优化函数中的初始旋转矩阵;将初始旋转矩阵和至少一个平面组的数据分别带入第一优化函数,确定第一优化函数的取值。在此过程中,对第一优化函数中的初始旋转矩阵进行调整。当第一优化函数的取值达到最小值时,确定第一优化函数中的初始旋转矩阵,作为第二标定参数中的旋转矩阵。
本实施例中,通过构造第一优化函数,利用多次标定数据和第一优化函数,使用优化方法自动地求取旋转矩阵,一方面,旋转矩阵的解算过程能够由外参标定设备自动化完成,而无需人工干预,从而提升标定效率,也避免人工干预带来的误差。另一方面,可以通过多次标定数据,自动地求取旋转矩阵,降低单次标定带来的误差。
在一些实施例中,外参标定设备根据至少一个平面组和第二优化函数,确定平移矩阵,平移矩阵使得第二优化函数的取值为最小值。
第二优化函数用于根据初始平移矩阵和至少一个平面组确定第一平面和第二平面之间的距离。第二优化函数的输入参数包括初始平移矩阵和至少一个平面组,第二优化函数的取值用于表示平面组中第一平面和第二平面之间的距离的大小。
例如,第二优化函数的表达式如下所示。
f2=min((RLT*P+TLT-p)*(a,b,c))
其中,f2表示第二优化函数。f2的含义为两个匹配平面之间的距离最小。RLT表示通过第一优化函数确定的旋转矩阵。TLT表示初始平移矩阵。(RLT*P+TLT-p)*(a,b,c)表示平面组中的第一平面和第二平面之间的距离,具体是指通过(A,B,C)表示的第二平面和通过(a,b,c)表示的第一平面之间的距离。当f2的取值接近0时,第一平面和第二平面重合。P表示第一平面上的点。p表示第二平面上的点。
如何利用第二优化函数确定平移矩阵包括多种方式。在一种可能的实现中,第二标定参数中的平移矩阵是在第二优化函数中的初始平移矩阵的基础上调整得到的。例如,确定第二优化函数中的初始平移矩阵;将初始平移矩阵和至少一个平面组的数据分别带入第二优化函数,确定第二优化函数的取值。在此过程中,对第二优化函数中的初始平移矩阵进行调整。当第二优化函数的取值达到最小值时,确定第二优化函数中的初始平移矩阵,作为第二标定参数中的平移矩阵。
本实施例中,通过构造第二优化函数,利用多次标定数据和第二优化函数,使用优化方法自动地求取平移矩阵,一方面,平移矩阵的解算过程能够由外参标定设备自动化完成,而无需人工干预,从而提升标定效率,也避免人工干预带来的误差。另一方面,可以通过多次标定数据,自动地求取平移矩阵,降低单次标定带来的误差。
在一些实施例中,旋转矩阵和平移矩阵是分步求解得到的。具体地,先根据至少一个平面组确定旋转矩阵;然后,根据已确定的旋转矩阵和至少一个平面组,确定平移矩阵。
如何利用已确定的旋转矩阵确定平移矩阵包括多种方式。在一种可能的实现中,外参标定设备使用已确定的旋转矩阵和初始平移矩阵,对第一平面上的点进行旋转变换和平移变换,得到该点的投影点;外参标定设备根据至少一个平面组,确定使得投影点和第二平面之间的距离最小的初始平移矩阵,作为平移矩阵。
可选地,利用已确定的旋转矩阵确定平移矩阵通过以上介绍的优化函数实现。例如,第二优化函数的取值是第一平面上的点的投影点和第二平面之间的距离。第二优化函数的输入参数包括旋转矩阵。在通过第一优化函数确定旋转矩阵后,将通过第一优化函数确定的旋转矩阵和初始平移矩阵带入至第二优化函数中。在通过第二优化函数进行运算的过程中,会在第一平面上取一点P;通过第一优化函数确定的旋转矩阵对点P进行旋转变换,通过初始平移矩阵,对点P进行平移变换,得到点P的投影点P’。计算投影点P’和第二平面之间的距离。当投影点P′和第二平面之间的距离的取值达到最小值时,确定第二优化函数中的初始旋转矩阵,作为第二标定参数中的旋转矩阵。
通过利用已确定的旋转矩阵确定平移矩阵,达到的效果包括:考虑到即使第一平面和第二平面之间的法向量夹角最小,也可能出现第一平面和第二平面并非完全平行,而是第一平面和第二平面之间相交的情况,导致难以直接计算出第一平面和第二平面之间的距离,进而导致难以根据平面之间的距离确定平移矩阵。而通过上述方式,将两个面之间的距离计算转换为点和平面之间的距离计算,由于第一平面和第二平面平行或非平行的情况下,投影点和第二平面之间的距离都是容易求解的,从而保证确定平移矩阵的方法的应用范围更广泛,提升了实用性。
其中,如何确定初始旋转矩阵和初始平移矩阵包括多种方式。在一种可能的实现中,对于一个平面组,获取第一平面上的第一点和第二平面上的第二点,根据第一点和第二点,通过矩阵分解的方式确定初始旋转矩阵和初始平移矩阵。可选地,第一点是第一平面上的任意一个点,第二点是第二平面上的任意一个点。本实施例中,并不要求第一点和第二点是同名点。可选地,第一点是第一平面的中心点。第二点是第二平面的中心点。
例如,第一设备是GNSS/IMU设备,第二设备为激光雷达,对于平面组i,取GNSS/IMU设备的坐标系下的平面上的一点p与对应的激光点云中平面内一点P,通过以下方程(5),通过矩阵分解求得初始RLT与初始TLT。其中,初始RLT是对初始旋转矩阵的举例说明,初始TLT是对初始平移矩阵的举例说明。
p*RLT+TLT=P: 方程(5)
S312、外参标定设备根据第一标定参数和第二标定参数,获取第二设备与第一设备之间的外参。
本实施例中,由于通过测量设备分别测量了第一设备和标定平面,通过第二设备测量了标定平面,测量设备的坐标系可以充当第一设备的坐标系和第二设备的坐标系之间的中继。根据步骤S307得到的第一标定参数和步骤S311得到的第二标定参数,能够确定第二设备与第一设备之间的外参。其中,第二设备与第一设备之间的外参包括第二设备与第一设备之间的旋转矩阵以及第二设备与第一设备之间的平移矩阵。在一种可能的实现中,联合方程(1)和方程(4),得到以下方程(6)。
方程(6)的含义是CT中任意一点pT分别经过RLT和RTI进行旋转变换,并分别经过TLT和TTI进行平移变换后,能够得到CI中的同名点pI。在方程(6)中,pL表示激光雷达的坐标系下的一点。RLT表示全站仪与激光雷达之间的旋转矩阵。TLT表示全站仪与激光雷达之间的旋转矩阵。RTI表示从全站仪至GNSS/IMU设备的旋转矩阵。TTI表示从全站仪至GNSS/IMU设备的平移矩阵。pI表示GNSS/IMU设备的坐标系中的点。CT表示全站仪的坐标系,CI表示GNSS/IMU设备的坐标系。CL表示激光雷达的坐标系。
在一些实施例中,在获得第二设备与第一设备之间的外参后,外参标定设备根据第一设备在世界坐标系下的位置和姿态、第二设备与第一设备之间的外参,获取第三标定参数,该第三标定参数用于表示第二设备与世界坐标系之间的坐标系转换关系。该第三标定参数包括第二设备的坐标系与世界坐标系之间的旋转矩阵以及第二设备的坐标系与世界坐标系之间的平移矩阵。
例如,第一设备是GNSS/IMU设备,第二设备为激光雷达,在GNSS/IMU设备工作过程中,能够获取GNSS/IMU设备的坐标原点在世界坐标系下的绝对位置和姿态。基于方程(6),通过以下方程(7)确定激光雷达与世界坐标系之间的坐标系转换关系。
方程(7)的含义是,CL中任意一点pL经过RIW旋转变换并经过TIW平移变换后,能够得到pL在Cw中的同名点pw。CL表示激光雷达的坐标系,Cw表示世界坐标系。在方程(7)中,pL表示激光雷达的坐标系CL下的一点,TIW表示GNSS/IMU设备的坐标原点在世界坐标系下的位置,RIW表示GNSS/IMU设备在世界坐标系的姿态。pw表示世界坐标系中的点。
应理解,本实施例对S307、S308和S309这三个步骤之间的时序不做限定。在一些实施例中,S307、S308和S309顺序执行。例如,先执行S307,再执行S308,再执行S309;又如,先执行S308,再执行S309,再执行S307;又如,先执行S308,再执行S307,再执行S309。在另一些实施例中,S307、S308和S309中的至少两项并行执行,即,同时执行S307、S308和S309中的至少两项。
应理解,本实施例对S301与S303的时序不做限定。在一些实施例中,S301与S303可以顺序执行。例如,可以先执行S301,再执行S303;也可以先执行S303,再执行S301。在另一些实施例中,S301与S303也可以并行执行,即,可以同时执行S301以及S303。
应理解,本实施例对S305与S303的时序不做限定。在一些实施例中,S305与S303可以顺序执行。例如,可以先执行S305,再执行S303;也可以先执行S303,再执行S305。在另一些实施例中,S305与S303也可以并行执行,即,可以同时执行S305以及S303。
应理解,本实施例仅是以同一个外参标定设备执行上述S307至S312为例进行说明,在一些实施例中,上述S307至S312可以由多台外参标定设备协作执行。
本实施例提供的方法,通过使用测量设备对第一设备进行测量,确定出测量设备与第一设备之间的坐标系转换关系,并通过使用测量设备和第二设备分别至少一个标定平面进行测量,确定出至少一个标定平面在测量设备和第二设备的坐标系下分别映射的至少一个平面组,利用至少一个平面组确定测量设备与第二设备之间的坐标系转换关系。这样,能够利用测量设备的坐标系,作为第一设备的坐标系与第二设备的坐标系之间的中继,找到第一设备与第二设备之间的外参。由于外参是通过确定出的平面组获得的,而不需要从点云数据中提取同名点,从而避免了同名点的提取过程对标定精度的影响,因此提高了标定精度。此外,该方法能够固化为计算机自动化执行的流程,避免了人工计算标定参数会带来的费时费力的问题,因此提高了标定效率。
以下通过方法400,对方法300进行举例说明。在方法400,测量设备为全站仪,标定平面为标定板,第一设备为GNSS/IMU设备,第二设备为激光雷达,外参标定设备为PC。换句话说,方法400描述的方法流程关于PC上如何利用全站仪和激光雷达对标定板的测量数据,确定激光雷达与GNSS/IMU设备之间的外参。
参见附图7,附图7为本申请实施例提供的一种激光雷达的外参标定方法400的流程图。示例性地,方法400包括S401至S404。
S401、全站仪观测标定板上的标志点。
S402、PC将全站仪的观测结果转换至GNSS/IMU设备的坐标系。
S403、激光雷达扫描标定板,得到点云数据。
S404、PC根据全站仪的观测结果和点云数据,进行平面提取与平面拟合。
S405、PC根据拟合的平面解算出外参,从而完成外参标定,将确定的外参保存至外参文件。
以上介绍了本申请实施例的方法300或方法400,以下介绍本申请实施例的外参标定装置,应理解,该外参标定装置具有上述方法300或方法400中外参标定设备的任意功能。
附图8是本申请实施例提供的一种外参标定装置500的结构示意图,如附图8所示,装置500包括:获取模块501,用于执行S307和S312;确定模块502,用于执行S308、S309、S310和S311。
应理解,装置500对应于上述方法实施例中的外参标定设备,装置500中的各模块和上述其他操作和/或功能分别为了实现方法300或方法400中的外参标定设备所实施的各种步骤和方法,具体细节可参见上述方法300或方法400,为了简洁,在此不再赘述。
应理解,装置500在标定外参时,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将装置500的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。另外,上述实施例提供的装置500与上述方法300或方法400属于同一构思,其具体实现过程详见方法300或方法400,这里不再赘述。
与本申请提供的方法实施例以及虚拟装置实施例相对应,本申请实施例还提供了一种外参标定设备,下面对外参标定设备的硬件结构进行介绍。
外参标定设备600对应于上述方法300或方法400中的外参标定设备或PC,外参标定设备600中的各硬件、模块和上述其他操作和/或功能分别为了实现方法实施例中外参标定设备或PC所实施的各种步骤和方法,关于外参标定设备600如何标定外参的详细流程,具体细节可参见上述方法300或方法400,为了简洁,在此不再赘述。其中,方法300或方法400的各步骤通过外参标定设备600处理器中的硬件的集成逻辑电路或者软件形式的指令完成。结合本申请实施例所公开的方法的步骤可以直接体现为硬件处理器执行完成,或者用处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器,处理器读取存储器中的信息,结合其硬件完成上述方法的步骤,为避免重复,这里不再详细描述。
外参标定设备600对应于上述外参标定装置500,装置500中的每个功能模块采用外参标定设备600的软件实现。换句话说,装置500包括的功能模块为外参标定设备600的处理器读取存储器中存储的程序代码后生成的。
参见附图9,附图9示出了本申请一个示例性实施例提供的外参标定设备600的结构示意图,例如,该外参标定设备600可以是主机、服务器或个人计算机等。该外参标定设备600可以由一般性的总线体系结构来实现。
外参标定设备600包括至少一个处理器601、通信总线602、存储器603以及至少一个通信接口604。
处理器601可以是一个通用中央处理器(central processing unit,CPU)、网络处理器(network processer,NP)、微处理器、或者可以是一个或多个用于实现本申请方案的集成电路,例如,专用集成电路(application-specific integrated circuit,ASIC),可编程逻辑器件(programmable logic device,PLD)或其组合。上述PLD可以是复杂可编程逻辑器件(complex programmable logic device,CPLD),现场可编程逻辑门阵列(field-programmable gate array,FPGA),通用阵列逻辑(generic array logic,GAL)或其任意组合。
通信总线602用于在上述组件之间传送信息。通信总线602可以分为地址总线、数据总线、控制总线等。为便于表示,附图9中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
存储器603可以是只读存储器(read-only memory,ROM)或可存储静态信息和指令的其它类型的静态存储设备,也可以是随机存取存储器(random access memory,RAM)或者可存储信息和指令的其它类型的动态存储设备,也可以是电可擦可编程只读存储器(electrically erasable programmable read-only Memory,EEPROM)、只读光盘(compactdisc read-only memory,CD-ROM)或其它光盘存储、光碟存储(包括压缩光碟、激光碟、光碟、数字通用光碟、蓝光光碟等)、磁盘存储介质或者其它磁存储设备,或者是能够用于携带或存储具有指令或数据结构形式的期望的程序代码并能够由计算机存取的任何其它介质,但不限于此。存储器603可以是独立存在,并通过通信总线602与处理器601相连接。存储器603也可以和处理器601集成在一起。
通信接口604使用任何收发器一类的装置,用于与其它设备或通信网络通信。通信接口604包括有线通信接口,还可以包括无线通信接口。其中,有线通信接口例如可以为以太网接口。以太网接口可以是光接口,电接口或其组合。无线通信接口可以为无线局域网(wireless local area networks,WLAN)接口,蜂窝网络通信接口或其组合等。
在具体实现中,作为一种实施例,处理器601可以包括一个或多个CPU,如附图9中所示的CPU0和CPU1。
在具体实现中,作为一种实施例,外参标定设备600可以包括多个处理器,如附图9中所示的处理器601和处理器605。这些处理器中的每一个可以是一个单核处理器(single-CPU),也可以是一个多核处理器(multi-CPU)。这里的处理器可以指一个或多个设备、电路、和/或用于处理数据(如计算机程序指令)的处理核。
在具体实现中,作为一种实施例,外参标定设备600还可以包括输出设备和输入设备。输出设备和处理器601通信,可以以多种方式来显示信息。例如,输出设备可以是液晶显示器(liquid crystal display,LCD)、发光二级管(light emitting diode,LED)显示设备、阴极射线管(cathode ray tube,CRT)显示设备或投影仪(projector)等。输入设备和处理器601通信,可以以多种方式接收用户的输入。例如,输入设备可以是鼠标、键盘、触摸屏设备或传感设备等。
在一些实施例中,存储器603用于存储执行本申请方案的程序代码610,处理器601可以执行存储器603中存储的程序代码610。也即是,外参标定设备600可以通过处理器601以及存储器603中的程序代码610,来实现方法实施例提供的外参标定方法。
本申请实施例的外参标定设备600可对应于上述各个方法实施例中的外参标定设备,并且,该外参标定设备600中的处理器601、通信接口604等可以实现上述各个方法实施例中的外参标定设备所具有的功能和/或所实施的各种步骤和方法。为了简洁,在此不再赘述。
应理解,装置500中的获取模块501、确定模块502相当于外参标定设备600中的处理器601或处理器605。
应理解,上述各种产品形态的外参标定设备,分别具有上述方法实施例中外参标定设备的任意功能,此处不再赘述。
本领域普通技术人员可以意识到,结合本文中所公开的实施例中描述的各方法步骤和单元,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各实施例的步骤及组成。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。本领域普通技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的系统、装置和模块的具体工作过程,可以参见前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的系统、装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,该模块的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个模块或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另外,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口、装置或模块的间接耦合或通信连接,也可以是电的,机械的或其它的形式连接。
该作为分离部件说明的模块可以是或者也可以不是物理上分开的,作为模块显示的部件可以是或者也可以不是物理模块,即可以位于一个地方,或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部模块来实现本申请实施例方案的目的。
另外,在本申请各个实施例中的各功能模块可以集成在一个处理模块中,也可以是各个模块单独物理存在,也可以是两个或两个以上模块集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。
该集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读存储介质中。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分,或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请各个实施例中方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(read-only memory,ROM)、随机存取存储器(random access memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
本申请中术语“第一”“第二”等字样用于对作用和功能基本相同的相同项或相似项进行区分,应理解,“第一”、“第二”之间不具有逻辑或时序上的依赖关系,也不对数量和执行顺序进行限定。还应理解,尽管以下描述使用术语第一、第二等来描述各种元素,但这些元素不应受术语的限制。这些术语只是用于将一元素与另一元素区别分开。例如,在不脱离各种所述示例的范围的情况下,第一标定参数可以被称为第二标定参数,并且类似地,第二标定参数可以被称为第一标定参数。第一标定参数和第二标定参数都可以是标定参数,并且在某些情况下,可以是单独且不同的标定参数。
本申请中术语“至少一个”的含义是指一个或多个,本申请中术语“多个”的含义是指两个或两个以上,例如,多个标定平面是指两个或两个以上的标定平面。
还应理解,术语“如果”可被解释为意指“当...时”(“when”或“upon”)或“响应于确定”或“响应于检测到”。类似地,根据上下文,短语“如果确定...”或“如果检测到[所陈述的条件或事件]”可被解释为意指“在确定...时”或“响应于确定...”或“在检测到[所陈述的条件或事件]时”或“响应于检测到[所陈述的条件或事件]”。
以上描述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以权利要求的保护范围为准。
在上述实施例中,可以全部或部分地通过软件、硬件、固件或者其任意组合来实现。当使用软件实现时,可以全部或部分地以计算机程序产品的形式实现。该计算机程序产品包括一个或多个计算机程序指令。在计算机上加载和执行该计算机程序指令时,全部或部分地产生按照本申请实施例中的流程或功能。该计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。该计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一个计算机可读存储介质传输,例如,该计算机程序指令可以从一个网站站点、计算机、服务器或数据中心通过有线或无线方式向另一个网站站点、计算机、服务器或数据中心进行传输。该计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。该可用介质可以是磁性介质(例如软盘、硬盘、磁带)、光介质(例如,数字视频光盘(digitalvideo disc,DVD)、或者半导体介质(例如固态硬盘)等。
本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成,也可以通过程序来指令相关的硬件完成,该程序可以存储于一种计算机可读存储介质中,上述提到的存储介质可以是只读存储器,磁盘或光盘等。
以上描述仅为本申请的可选实施例,并不用以限制本申请,凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。
Claims (20)
1.一种外参标定方法,其特征在于,所述方法包括:
根据测量设备对第一设备的测量数据,获取第一标定参数,所述第一标定参数用于表示所述测量设备与所述第一设备之间的坐标系转换关系;
根据所述测量设备对至少一个标定平面的测量数据,确定所述至少一个标定平面在所述测量设备的坐标系下映射的至少一个第一平面;
根据第二设备对所述至少一个标定平面的测量数据,确定所述至少一个标定平面在所述第二设备的坐标系下映射的至少一个第二平面;
根据所述至少一个第一平面和所述至少一个第二平面,确定至少一个平面组,所述平面组包括第一平面和第二平面,所述平面组中的第一平面与第二平面对应;
根据所述至少一个平面组,确定第二标定参数,所述第二标定参数用于表示所述测量设备与所述第二设备之间的坐标系转换关系;
根据所述第一标定参数和所述第二标定参数,获取所述第二设备与所述第一设备之间的外参。
2.根据权利要求1所述的方法,其特征在于,所述根据所述至少一个平面组,确定第二标定参数,包括:
根据所述至少一个平面组,所述平面组中的第一平面和第二平面满足匹配条件,确定第二标定参数。
3.根据权利要求2所述的方法,其特征在于,所述平面组中的第一平面和第二平面满足匹配条件,包括:
所述平面组中的第一平面和第二平面之间的法向量夹角最小。
4.根据权利要求3所述的方法,其特征在于,所述第二标定参数包括旋转矩阵,所述根据所述至少一个平面组,所述平面组中的第一平面和第二平面之间的法向量夹角最小,确定第二标定参数,包括:
根据所述至少一个平面组和第一优化函数,确定所述旋转矩阵,所述旋转矩阵使得所述第一优化函数的取值为最小值。
5.根据权利要求1-4任一项所述的方法,其特征在于,所述平面组中的第一平面和第二平面满足匹配条件,包括:
所述平面组中的第一平面和第二平面之间的距离最小。
6.根据权利要求5所述的方法,其特征在于,所述第二标定参数包括平移矩阵,所述根据所述至少一个平面组,所述平面组中的第一平面和第二平面之间的距离最小,确定第二标定参数,包括:
根据所述至少一个平面组和第二优化函数,确定所述平移矩阵,所述平移矩阵使得所述第二优化函数的取值为最小值。
7.根据权利要求1至6中任一项所述的方法,其特征在于,所述第二标定参数包括平移矩阵,所述根据所述至少一个平面组,确定第二标定参数,包括:
使用所述旋转矩阵和初始平移矩阵,对第一平面上的点进行旋转变换和平移变换,得到所述点的投影点;
根据所述至少一个平面组,确定使得所述投影点和所述第二平面之间的距离最小的初始平移矩阵,作为所述平移矩阵。
8.根据权利要求1所述的方法,其特征在于,所述根据测量设备对第一设备的测量数据,获取第一标定参数,包括:
根据所述第一设备上的标志点在所述第一设备的坐标系下的坐标值和所述测量设备测量得到的所述标志点在所述测量设备的坐标系下的坐标值,获取所述第一标定参数。
9.根据权利要求1所述的方法,其特征在于,所述测量设备为全站仪、激光扫描仪或摄影测量系统,所述标定平面为标定板或墙,所述第一设备为惯导设备、车辆或第一激光雷达,所述第二设备为第二激光雷达、毫米波或相机。
10.一种外参标定装置,其特征在于,所述装置包括:
获取模块,用于根据测量设备对第一设备的测量数据,获取第一标定参数,所述第一标定参数用于表示所述测量设备与所述第一设备之间的坐标系转换关系;
确定模块,用于根据所述测量设备对至少一个标定平面的测量数据,确定所述至少一个标定平面在所述测量设备的坐标系下映射的至少一个第一平面;
确定模块,用于根据第二设备对所述至少一个标定平面的测量数据,确定所述至少一个标定平面在所述第二设备的坐标系下映射的至少一个第二平面;
确定模块,用于根据所述至少一个第一平面和所述至少一个第二平面,确定至少一个平面组,所述平面组包括第一平面和第二平面,所述平面组中的第一平面与第二平面对应;
确定模块,用于根据所述至少一个平面组,确定第二标定参数,所述第二标定参数用于表示所述测量设备与所述第二设备之间的坐标系转换关系;
所述获取模块,还用于根据所述第一标定参数和所述第二标定参数,获取所述第二设备与所述第一设备之间的外参。
11.根据权利要求10所述的装置,其特征在于,所述确定模块,用于根据所述至少一个平面组,所述平面组中的第一平面和第二平面满足匹配条件,确定第二标定参数。
12.根据权利要求11所述的装置,其特征在于,所述平面组中的第一平面和第二平面满足匹配条件,包括:所述平面组中的第一平面和第二平面之间的法向量夹角最小。
13.根据权利要求12所述的装置,其特征在于,所述第二标定参数包括旋转矩阵,所述确定模块,用于根据所述至少一个平面组和第一优化函数,确定所述旋转矩阵,所述旋转矩阵使得所述第一优化函数的取值为最小值。
14.根据权利要求10-13任一项所述的装置,其特征在于,所述平面组中的第一平面和第二平面满足匹配条件,包括:所述平面组中的第一平面和第二平面之间的距离最小。
15.根据权利要求14所述的装置,其特征在于,所述第二标定参数包括平移矩阵,所述确定模块,用于根据所述至少一个平面组和第二优化函数,确定所述平移矩阵,所述平移矩阵使得所述第二优化函数的取值为最小值。
16.根据权利要求10至15中任一项所述的装置,其特征在于,所述第二标定参数包括平移矩阵,所述确定模块,用于使用所述旋转矩阵和初始平移矩阵,对第一平面上的点进行旋转变换和平移变换,得到所述点的投影点;根据所述至少一个平面组,确定使得所述投影点和所述第二平面之间的距离最小的初始平移矩阵,作为所述平移矩阵。
17.根据权利要求10所述的装置,其特征在于,所述获取模块,用于根据所述第一设备上的标志点在所述第一设备的坐标系下的坐标值和所述测量设备测量得到的所述标志点在所述测量设备的坐标系下的坐标值,获取所述第一标定参数。
18.根据权利要求10所述的装置,其特征在于,所述测量设备为全站仪、激光扫描仪或摄影测量系统,所述标定平面为标定板或墙,所述第一设备为惯导设备、车辆或第一激光雷达,所述第二设备为第二激光雷达、毫米波或相机。
19.一种外参标定设备,其特征在于,所述外参标定设备包括处理器,所述处理器用于执行指令,使得所述外参标定设备执行如权利要求1至权利要求9中任一项所述的方法。
20.一种计算机可读存储介质,其特征在于,所述存储介质中存储有至少一条指令,所述指令由处理器读取以使外参标定设备执行如权利要求1至权利要求9中任一项所述的方法。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2020/092652 WO2021237520A1 (zh) | 2020-05-27 | 2020-05-27 | 外参标定方法、装置、设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112654886A true CN112654886A (zh) | 2021-04-13 |
CN112654886B CN112654886B (zh) | 2022-01-11 |
Family
ID=75368438
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202080004813.1A Active CN112654886B (zh) | 2020-05-27 | 2020-05-27 | 外参标定方法、装置、设备及存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN112654886B (zh) |
WO (1) | WO2021237520A1 (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113269840A (zh) * | 2021-05-27 | 2021-08-17 | 深圳一清创新科技有限公司 | 一种用于相机和多激光雷达的联合标定方法及电子设备 |
CN113567964A (zh) * | 2021-06-29 | 2021-10-29 | 苏州一径科技有限公司 | 激光雷达自动测试方法及装置、系统 |
CN113639782A (zh) * | 2021-08-13 | 2021-11-12 | 北京地平线信息技术有限公司 | 车载传感器的外参标定方法和装置、设备和介质 |
WO2021254014A1 (zh) * | 2020-06-17 | 2021-12-23 | Oppo广东移动通信有限公司 | 显示标定方法及装置、设备、存储介质 |
CN113884278A (zh) * | 2021-09-16 | 2022-01-04 | 杭州海康机器人技术有限公司 | 一种线激光设备的系统标定方法和装置 |
CN114152937A (zh) * | 2022-02-09 | 2022-03-08 | 西南科技大学 | 一种旋转激光雷达的外参标定方法 |
CN114545348A (zh) * | 2022-02-25 | 2022-05-27 | 中电科技扬州宝军电子有限公司 | 一种基于svd的雷达系统误差的标定方法 |
CN114565681A (zh) * | 2022-03-01 | 2022-05-31 | 禾多科技(北京)有限公司 | 一种相机标定方法、装置、设备、介质及产品 |
CN114782556A (zh) * | 2022-06-20 | 2022-07-22 | 季华实验室 | 相机与激光雷达的配准方法、系统及存储介质 |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114413887B (zh) * | 2021-12-24 | 2024-04-02 | 北京理工大学前沿技术研究院 | 一种传感器外部参数标定方法、设备及介质 |
CN114488097A (zh) * | 2022-01-26 | 2022-05-13 | 广州小鹏自动驾驶科技有限公司 | 激光雷达的外参标定方法、计算机设备及计算机存储介质 |
CN116734727B (zh) * | 2022-10-08 | 2024-06-25 | 荣耀终端有限公司 | 定位方法及装置 |
CN115388914B (zh) * | 2022-10-28 | 2023-02-03 | 福思(杭州)智能科技有限公司 | 传感器的参数标定方法、装置、存储介质和电子装置 |
CN115953484B (zh) * | 2023-03-13 | 2023-07-04 | 福思(杭州)智能科技有限公司 | 探测设备的参数标定方法和装置、存储介质及电子装置 |
CN115994955B (zh) * | 2023-03-23 | 2023-07-04 | 深圳佑驾创新科技有限公司 | 相机外参标定方法、装置和车辆 |
CN116148822B (zh) * | 2023-03-28 | 2023-11-03 | 安徽海博智能科技有限责任公司 | 一种应用于露天矿山无人驾驶的多激光雷达自动标定方法 |
CN116659555B (zh) * | 2023-07-31 | 2023-10-27 | 天津七六四通信导航技术有限公司 | 一种全站仪坐标到车体坐标的误差修正方法 |
CN117073581B (zh) * | 2023-09-12 | 2024-01-26 | 梅卡曼德(北京)机器人科技有限公司 | 线激光轮廓仪系统的标定方法、装置和电子设备 |
CN117554937B (zh) * | 2024-01-08 | 2024-04-26 | 安徽中科星驰自动驾驶技术有限公司 | 一种误差可控的激光雷达和组合惯导外参标定方法和系统 |
CN118068358B (zh) * | 2024-04-19 | 2024-07-05 | 临沂大学 | 一种激光雷达与惯性测量单元外参标定的无奇异方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007256091A (ja) * | 2006-03-23 | 2007-10-04 | Space Vision:Kk | レンジファインダ校正方法及び装置 |
JP2008187564A (ja) * | 2007-01-31 | 2008-08-14 | Sanyo Electric Co Ltd | カメラ校正装置及び方法並びに車両 |
CN101408430A (zh) * | 2007-10-09 | 2009-04-15 | 罗剑 | 基于无源射频地标的汽车导航与自动驾驶系统 |
CN101699313A (zh) * | 2009-09-30 | 2010-04-28 | 北京理工大学 | 基于摄像机和三维激光雷达的外部参数标定方法及系统 |
CN102506852A (zh) * | 2011-11-01 | 2012-06-20 | 丁幼春 | 农用车辆视觉导航系统及其导航方法 |
CN106737859A (zh) * | 2016-11-29 | 2017-05-31 | 江苏瑞伯特视觉科技股份有限公司 | 基于不变平面的传感器与机器人的外部参数标定方法 |
CN109215086A (zh) * | 2018-08-24 | 2019-01-15 | 深圳市寒武纪智能科技有限公司 | 相机外参标定方法、设备及系统 |
CN109242912A (zh) * | 2018-08-29 | 2019-01-18 | 杭州迦智科技有限公司 | 采集装置外参标定方法、电子设备、存储介质 |
CN111190153A (zh) * | 2020-04-09 | 2020-05-22 | 上海高仙自动化科技发展有限公司 | 外参标定方法及装置、智能机器人及计算机可读存储介质 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100414253C (zh) * | 2007-07-06 | 2008-08-27 | 北京航空航天大学 | 一种数字式太阳敏感器标定方法及装置 |
CN106546262B (zh) * | 2016-10-11 | 2019-05-10 | 山东科技大学 | 基于平面控制和约束结合的移动测量系统外参数标定方法 |
-
2020
- 2020-05-27 CN CN202080004813.1A patent/CN112654886B/zh active Active
- 2020-05-27 WO PCT/CN2020/092652 patent/WO2021237520A1/zh active Application Filing
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007256091A (ja) * | 2006-03-23 | 2007-10-04 | Space Vision:Kk | レンジファインダ校正方法及び装置 |
JP2008187564A (ja) * | 2007-01-31 | 2008-08-14 | Sanyo Electric Co Ltd | カメラ校正装置及び方法並びに車両 |
CN101408430A (zh) * | 2007-10-09 | 2009-04-15 | 罗剑 | 基于无源射频地标的汽车导航与自动驾驶系统 |
CN101699313A (zh) * | 2009-09-30 | 2010-04-28 | 北京理工大学 | 基于摄像机和三维激光雷达的外部参数标定方法及系统 |
CN102506852A (zh) * | 2011-11-01 | 2012-06-20 | 丁幼春 | 农用车辆视觉导航系统及其导航方法 |
CN106737859A (zh) * | 2016-11-29 | 2017-05-31 | 江苏瑞伯特视觉科技股份有限公司 | 基于不变平面的传感器与机器人的外部参数标定方法 |
CN109215086A (zh) * | 2018-08-24 | 2019-01-15 | 深圳市寒武纪智能科技有限公司 | 相机外参标定方法、设备及系统 |
CN109242912A (zh) * | 2018-08-29 | 2019-01-18 | 杭州迦智科技有限公司 | 采集装置外参标定方法、电子设备、存储介质 |
CN111190153A (zh) * | 2020-04-09 | 2020-05-22 | 上海高仙自动化科技发展有限公司 | 外参标定方法及装置、智能机器人及计算机可读存储介质 |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021254014A1 (zh) * | 2020-06-17 | 2021-12-23 | Oppo广东移动通信有限公司 | 显示标定方法及装置、设备、存储介质 |
CN113269840A (zh) * | 2021-05-27 | 2021-08-17 | 深圳一清创新科技有限公司 | 一种用于相机和多激光雷达的联合标定方法及电子设备 |
CN113567964A (zh) * | 2021-06-29 | 2021-10-29 | 苏州一径科技有限公司 | 激光雷达自动测试方法及装置、系统 |
CN113639782A (zh) * | 2021-08-13 | 2021-11-12 | 北京地平线信息技术有限公司 | 车载传感器的外参标定方法和装置、设备和介质 |
CN113884278A (zh) * | 2021-09-16 | 2022-01-04 | 杭州海康机器人技术有限公司 | 一种线激光设备的系统标定方法和装置 |
CN113884278B (zh) * | 2021-09-16 | 2023-10-27 | 杭州海康机器人股份有限公司 | 一种线激光设备的系统标定方法和装置 |
CN114152937A (zh) * | 2022-02-09 | 2022-03-08 | 西南科技大学 | 一种旋转激光雷达的外参标定方法 |
CN114545348A (zh) * | 2022-02-25 | 2022-05-27 | 中电科技扬州宝军电子有限公司 | 一种基于svd的雷达系统误差的标定方法 |
CN114565681A (zh) * | 2022-03-01 | 2022-05-31 | 禾多科技(北京)有限公司 | 一种相机标定方法、装置、设备、介质及产品 |
CN114782556A (zh) * | 2022-06-20 | 2022-07-22 | 季华实验室 | 相机与激光雷达的配准方法、系统及存储介质 |
CN114782556B (zh) * | 2022-06-20 | 2022-09-09 | 季华实验室 | 相机与激光雷达的配准方法、系统及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN112654886B (zh) | 2022-01-11 |
WO2021237520A1 (zh) | 2021-12-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112654886B (zh) | 外参标定方法、装置、设备及存储介质 | |
EP2993490B1 (en) | Operating device, operating method, and program therefor | |
CN110501712B (zh) | 无人驾驶中用于确定位置姿态数据的方法、装置和设备 | |
CN110849363B (zh) | 激光雷达与组合惯导的位姿标定方法、系统及介质 | |
CN112825190B (zh) | 一种精度评估方法、系统、电子设备和存储介质 | |
JPWO2007069721A1 (ja) | 三次元形状データの記憶・表示方法と装置および三次元形状の計測方法と装置 | |
CN110686704A (zh) | 激光雷达与组合惯导的位姿标定方法、系统及介质 | |
KR101782317B1 (ko) | 3차원 스캐너를 이용한 로봇 캘리브레이션 장치 및 이를 이용한 로봇 캘리브레이션 방법 | |
CN107727118B (zh) | 大型飞行器中的gnc分系统设备姿态测量系统标定方法 | |
CN115825067A (zh) | 一种基于无人机的地质信息采集方法、系统及电子设备 | |
Yang et al. | A cost-effective non-orthogonal 3D measurement system | |
CN114049401A (zh) | 双目相机标定方法、装置、设备及介质 | |
CN107504959B (zh) | 利用倾斜航空影像测量房屋墙基轮廓的方法 | |
CN113592951A (zh) | 车路协同中路侧相机外参标定的方法、装置、电子设备 | |
CN113759348A (zh) | 一种雷达标定方法、装置、设备及存储介质 | |
CN111220118B (zh) | 基于视觉惯性导航系统的激光测距仪及测距方法 | |
KR20190086951A (ko) | 레이저 관측 장비를 이용한 mms의 캘리브레이션을 위한 장치 및 방법 | |
KR101237434B1 (ko) | 측량기를 이용한 3차원 건축실물모델링 방법 | |
Manouchehri et al. | Extrinsic calibration of a camera and a 2D laser range finder using ping pong balls and the corner of a room | |
CN116203976A (zh) | 变电站室内巡检方法、装置、无人机和存储介质 | |
RU2645432C1 (ru) | Способ калибровки видеограмметрических систем и контрольное приспособление для его осуществления | |
CN110866951B (zh) | 一种单目摄像机光轴倾斜的校正方法 | |
CN113790711A (zh) | 一种无人机低空飞行位姿无控多视测量方法及存储介质 | |
CN113034615A (zh) | 一种用于多源数据融合的设备标定方法及相关装置 | |
Klug et al. | Measuring Human-made Corner Structures with a Robotic Total Station using Support Points, Lines and Planes. |
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 |