CN118050707A - 激光雷达的标定方法及装置、存储介质、终端设备 - Google Patents
激光雷达的标定方法及装置、存储介质、终端设备 Download PDFInfo
- Publication number
- CN118050707A CN118050707A CN202211435761.0A CN202211435761A CN118050707A CN 118050707 A CN118050707 A CN 118050707A CN 202211435761 A CN202211435761 A CN 202211435761A CN 118050707 A CN118050707 A CN 118050707A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- calibration
- laser radar
- point cloud
- cloud data
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 73
- 239000013598 vector Substances 0.000 claims description 27
- 238000013519 translation Methods 0.000 claims description 22
- 230000008859 change Effects 0.000 claims description 21
- 239000011159 matrix material Substances 0.000 claims description 17
- 238000004590 computer program Methods 0.000 claims description 14
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000012935 Averaging Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 abstract description 28
- 238000005259 measurement Methods 0.000 description 7
- 238000012216 screening Methods 0.000 description 6
- 230000009466 transformation Effects 0.000 description 6
- 238000001514 detection method Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000008447 perception Effects 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000007774 longterm Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
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
- G01S7/4972—Alignment of sensor
-
- 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
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/42—Simultaneous measurement of distance and other co-ordinates
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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/4808—Evaluating distance, position or velocity data
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明提供一种激光雷达的标定方法及装置、存储介质、终端设备,激光雷达的标定方法包括:获取激光雷达的点云数据;利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿;根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,所述车辆前进坐标系X轴的方向为所述车辆直线行驶时的行驶方向,所述标定参数包括俯仰角和横摆角。通过本发明技术方案能够在车辆正常行驶过程中实现激光雷达到车辆坐标系的实时标定,标定算法简单,精度高。
Description
技术领域
本发明涉及激光雷达领域,尤其涉及一种激光雷达的标定方法及装置、存储介质、终端设备。
背景技术
对于车辆而言,将车载传感器坐标系转换到车辆坐标系是车辆感知决策的关键前提。因此将传感器安装到车辆上之后,需要对其进行标定。激光雷达是目前以及未来车辆上广泛使用的精密传感器。激光雷达的标定是指求解激光雷达坐标系相对于车辆坐标系的相对变换关系,即获得旋转平移变换矩阵,从而在车辆坐标系下得到激光雷达的检测结果,方便后续的感知计算。基于激光雷达的车载三维重建系统和感知系统工作时需要对激光雷达的参数:三个旋转参数(roll,pitch,yaw)和三个平移参数(x,y,z)进行标定。其中,roll表示翻滚角,为围绕X轴旋转的角度;pitch表示俯仰角,为围绕Y轴旋转的角度;yaw表示偏航角,表示围绕Z轴旋转的角度。
现有技术中,激光雷达标定方案多为下线标定(离线标定),即在激光雷达系统安装到车辆上,然后在车辆静止的情况下,基于固定的场景、标靶、摆阵器等实现对激光雷达设备的外部参数的标定。但颠簸、震动、固定件的松动,以及环境或者地域温度的变化,激光雷达坐标系与车辆坐标系的相对位置关系会发生变化,因此下线的标定结果并不能时刻保持精准,那么使用下线标定参数进行感知则可能会产生误差,可能导致感知任务的错误,威胁车辆的行驶安全。因此,如图1所示,现有技术中还会进行实时标定,根据采用的车辆坐标系的不同,大致有以下方案:在车辆运动过程中将雷达坐标系标定到车辆机械坐标系;或者将雷达坐标系标定到惯性导航系统(Inertial Navigation System,INS)坐标系的方案。
但是,现有实时标定方案存在以下问题。如图1所示,车辆的机械坐标系的原点与车辆质心重合,X轴平行于地面指向车辆前方,Z轴垂直地面指向上方。因此车辆的机械坐标系与车辆的各个部件的位置、结构密切相关。因此存在着车辆的机械坐标系往往因为装配误差或者长时间使用磨损而发生偏移的问题,同时在行进过程中车辆车轴与激光雷达的相对关系难以观测,即车辆难以准确感知自身的车轴方位。而将雷达坐标系标定到INS坐标系时,车辆实时标定时要求车辆持续进行大角度转弯行驶才能完成标定,通常需要车辆在场地中走“8”字,如图2所示,因此必须在特地场地下沿特定轨迹运行;此外,对INS的精度要求较高,否则将导致标定参数的精度低。
发明内容
本发明解决的技术问题是如何简便准确地对激光雷达进行标定。
为解决上述技术问题,第一方面,本发明实施例提供一种激光雷达的标定方法,激光雷达的标定方法包括:获取激光雷达的点云数据;利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿;根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,所述车辆前进坐标系X轴的方向为所述车辆直线行驶时的行驶方向,所述标定参数包括俯仰角和横摆角。
可选的,所述利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿之前,还包括:判断所述车辆的行驶状态是否满足标定条件,当车辆的行驶状态满足所述标定条件时,启动标定程序。
可选的,所述标定条件包括所述车辆基本处于直线行驶状态。
可选的,当所述车辆行驶的横摆角速度小于第一门限阈值时确定所述车辆基本处于直线行驶状态。
可选的,所述标定条件还包括所述车辆行驶的线速度超过第二门限阈值。
可选的,所述标定条件包括车辆基本处于直线行驶状态和所述线速度超过第二门限阈值的持续时长达到门限时长。
可选的,所述获取激光雷达的点云数据,具体包括:获取所述激光雷达的点云数据;所述点云数据满足以下一种或多种条件时,选取所述点云数据,以用于计算所述相对位姿:相邻两帧点云数据的时间差小于等于第三门限阈值;相邻两帧点云数据中前一帧点云数据的时间早于所述相邻帧点云数据中当前帧点云数据的时间;利用所述点云数据计算所述激光雷达在相邻帧之间的移动线速度和角速度,且所述移动线速度差异小于等于第四门限阈值和角速度差异小于等于第五门限阈值;所述点云数据中特定目标物体的特征数量大于等于第三门限阈值。
可选的,所述利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿,具体包括:利用所述点云数据中的相邻两帧点云数据计算所述激光雷达的位姿变化,获得所述相对位姿。
可选的,所述相对位姿包括旋转矩阵和平移向量;所述根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,具体包括:通过计算所述平移向量与所述激光雷达坐标系水平轴的夹角确定所述激光雷达坐标系到所述车辆前进坐标系的标定参数。
可选的,所述激光雷达的标定方法还包括:将多次标定获得的标定参数进行平均,以获得最终的标定结果。
第二方面,本发明还公开一种激光雷达的标定装置,激光雷达的标定装置包括:获取模块,用于获取激光雷达的点云数据;位姿计算模块,用于利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿;标定参数计算模块,用于根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,所述车辆前进坐标系X轴的方向为所述车辆直线行驶时的行驶方向,所述标定参数包括俯仰角和横摆角。
第三方面,本发明还公开一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被计算机运行时执行激光雷达的标定方法的步骤。
第四方面,本发明还公开一种终端设备,包括存储器和处理器,所述存储器上存储有可在所述处理器上运行的计算机程序,所述处理器运行所述计算机程序时执行激光雷达的标定方法的步骤。
与现有技术相比,本发明实施例的技术方案具有以下有益效果:
本发明技术方案中,以车辆直线行驶时的行驶方向作为车辆前进坐标系X轴的方向,并通过点云数据获得的激光雷达的相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数。通过上述标定方法实现激光雷达坐标系到车辆前进坐标系的标定,该标定方法中前进坐标系的方位可以容易地通过点云数据观测到,且不需要车辆进行特定轨迹的大角度转动,使得标定过程能够在车辆正常行驶过程中完成,实现了标定的便捷性;此外,本发明中的标定过程不依赖惯性导航系统的精度,保证了标定参数的准确性和稳定性。
进一步地,车辆的行驶状态满足标定条件时,启动标定程序。标定条件包括车辆基本处于直线行驶状态,以及车辆行驶的线速度超过第二门限阈值。本发明通过设置标定条件车辆基本处于直线行驶状态,使得车辆的实际行驶方向与车辆前进坐标系X轴的方向是重合的,当通过点云数据计算出车辆直线行驶时的行驶方向后,即可获知车辆的前进坐标系方位,从而保证激光雷达坐标系到车辆前进坐标系的正确标定;通过设置标定条件车辆行驶的线速度超过第二门限阈值,使得车载激光雷达的位姿具有明显变化,与激光雷达的测量误差产生的相对位姿进行区分,进一步保证激光雷达标定的准确性。
进一步地,本发明还利用一种或多种条件对点云数据进行筛选,并使用筛选后的点云数据计算激光雷达的相对位姿,使得筛选后的点云数据具有较高的可靠性以及置信度,从而使得激光雷达的相对位姿更加准确,进而使得激光雷达标定具有更高的准确性。
附图说明
附图用来提供对本发明的进一步理解,并且构成说明书的一部分,与本发明的实施例一起用于解释本发明,并不构成对本发明的限制。在附图中:
图1是现有技术中一种机械坐标系的示意图;
图2是现有技术中一种实时标定场景的示意图;
图3是本发明实施例提供的一种激光雷达的标定方法的流程图;
图4是本发明实施例提供的一种车辆前进坐标系的示意图;
图5是本发明实施例提供的另一种激光雷达的标定方法的流程图;
图6是本发明实施例提供的一种车辆前进坐标系与行驶方向的示意图;
图7是本发明实施例提供的又一种激光雷达的标定方法的流程图;
图8是本发明实施例提供的一种应用场景的示意图;
图9是本发明实施例提供的一种激光雷达的标定装置的结构示意图。
具体实施方式
如背景技术中所述,车辆的机械坐标系往往因为装配误差或者长时间使用磨损而发生偏移的问题,同时在行进过程中车辆车轴与激光雷达的相对关系难以观测,即车辆难以准确感知自身的车轴方位。而将雷达坐标系标定到INS坐标系时,车辆实时标定时要求车辆持续进行大角度转弯行驶才能完成标定,通常需要车辆在场地中走“8”字,如图2所示,因此必须在特地场地下沿特定轨迹运行;此外,对INS的精度要求较高,否则将导致标定参数的精度低。
本发明技术方案中,定义车辆前进坐标系为车辆坐标系,其中车辆前进坐标系X轴方向为车辆直行时的前进方向,并通过点云数据获得激光雷达在两帧点云间的相对位姿,根据相对位姿来计算激光雷达坐标系到车辆前进坐标系的标定参数。通过上述标定方法实现激光雷达坐标系到车辆前进坐标系的标定,该标定方法中前进坐标系的方位可以容易地通过点云数据观测到,且不需要车辆进行特定轨迹的大角度转动,使得标定过程能够在车辆正常行驶过程中完成,实现了标定的便捷性;此外,本发明中的标定过程不依赖惯性导航系统的精度,保证了标定参数的准确性和稳定性。
进一步地,车辆的行驶状态满足标定条件时,启动标定程序。标定条件包括车辆基本处于直线行驶状态,以及车辆行驶的线速度超过第二门限阈值。本发明通过设置标定条件车辆基本处于直线行驶状态,使得车辆的实际行驶方向与车辆前进坐标系X轴的方向是重合的,当通过点云数据计算出车辆直线行驶时的行驶方向后,即可获知车辆的前进坐标系方位,从而保证激光雷达坐标系到车辆前进坐标系的正确标定;通过设置标定条件车辆行驶的线速度超过第二门限阈值,使得车载激光雷达的位姿具有明显变化,与激光雷达的测量误差产生的相对位姿进行区分,进一步保证激光雷达标定的准确性。
进一步地,本发明还利用一种或多种条件对点云数据进行筛选,并使用筛选后的点云数据计算激光雷达的相对位姿,使得筛选后的点云数据具有较高的可靠性以及置信度,从而使得激光雷达的相对位姿更加准确,进而使得激光雷达标定具有更高的准确性。
为使本发明的上述目的、特征和优点能够更为明显易懂,下面结合附图对本发明的具体实施例做详细的说明。
图3是本发明实施例提供的一种激光雷达的标定方法的流程图。
请参照图3,所述方法包括以下步骤:
步骤301:获取激光雷达的点云数据;
步骤302:利用点云数据计算激光雷达的位姿变化,获得相对位姿;
步骤303:根据相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,车辆前进坐标系X轴的方向为车辆直线行驶时的行驶方向,标定参数包括俯仰角和横摆角。
需要指出的是,本实施例中各个步骤的序号并不代表对各个步骤的执行顺序的限定。
可以理解的是,在具体实施中,所述激光雷达的标定方法可以采用软件程序的方式实现,该软件程序运行于芯片或芯片模组内部集成的处理器中。该方法也可以采用软件结合硬件的方式实现,本发明不作限制。
本实施例中,激光雷达可以是与车辆固定连接的车载激光雷达。当车辆运动时,激光雷达与车辆一起移动,因此在较短时间内激光雷达的运动方向与车辆的运动方向保持一致。
在步骤301和步骤302的具体实施中,可以通过激光雷达采集到的点云数据计算激光雷达在运动前后的位姿变化,以获得激光雷达的相对位姿。车辆在运动过程中,激光雷达随之运动,因此两个不同时刻激光雷达的位姿会发生变化(包括平移和旋转)。激光雷达可以以某一时刻为起点(例如启动时刻或其他时刻),累计帧间位姿变换,得到各帧时刻激光雷达相对起点时刻的位姿(位置和方向),进而可以得到任意两帧点云间的相对位姿。
举例而言,激光雷达的相对位姿可以是tk时刻激光雷达的位姿相对于tk-1时刻的位姿的相对变化。tk时刻相对于tk-1时刻激光雷达的相对位姿可以通过tk时刻点云相对于起点时刻点云的位姿和tk-1时刻点云相对于起点时刻点云的位姿计算得到。tk时刻的点云和tk-1时刻的点云可以是直接相邻的两帧点云,也可以是间隔几帧的点云。通常激光雷达直接相邻的两帧点云之间的时间间隔在0.1s量级,时间较短,在如此短的时间内可以认为激光雷达与车辆的相对位置关系不会发生变动,从而可以由激光雷达的行驶方向获得。激光雷达的行驶方向可以从激光雷达的相对位姿中获得车辆行驶方向,相对位姿表示两个时刻下激光雷达的位置姿态变化关系,从中可以直接计算出激光雷达的行驶方向,下文将会进行详细描述。相对位姿可以利用位姿矩阵来表示,位姿矩阵可以包括旋转矩阵和平移向量。具体地,上述点云数据可以是车辆在行驶时间段内激光雷达采集到的点云数据。
在步骤303的具体实施中,可以根据相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数。标定参数可以表示激光雷达坐标系与车辆前进坐标系的相对位置关系。其中,请一并参照图4,车辆前进坐标系通常是笛卡尔坐标系,它的原点C1可以设在车辆的中心,车辆前进坐标系X轴(如图4中X1所示)的方向为车辆直线行驶时的行驶方向。车辆前进坐标系Z轴(如图3中Z1所示)为竖直向上的方向,车辆前进坐标系Y轴(如图3中Y1所示)为与X轴位于同一平面且与X轴相垂直的方向。根据前进坐标系的定义可知,当车辆直线行驶时,前进坐标系X轴与车辆速度方向重合,当车辆转弯时,前进坐标系X轴与车辆速度方向存在夹角。从而可以通过车辆的姿态信息来确定前进坐标系的方位。
继续参照图4,激光雷达坐标系也可以设为是笛卡尔坐标系,它的原点C2可以是激光雷达中心所在的位置,激光雷达坐标系X轴(如图3中X2所示)与车辆前进坐标系X轴存在一定的夹角,该夹角与实际应用中激光雷达在车辆上的安装位置有关,本发明对此不作限制。
上述步骤301至步骤303所述的标定过程是在车辆行驶过程中完成的,因此上述标定过程可以称为实时标定。
通常而言,激光雷达坐标系到车辆前进坐标系的标定参数包括6个自由度,也即三个平移自由度(x,y,z)和三个旋转自由度:翻滚(roll),俯仰(pitch),横摆(yaw)。通过步骤303获得的标定参数包括俯仰角和横摆角。实时标定中,由于运动激励自由度有限(车辆运动近似为平面运动),相对位置中部分自由度可观性较差,无法实现准确标定,且对感知数据(如点云数据)从激光雷达坐标系到车辆前进坐标系的转换影响较小。
具体地,平移自由度对感知数据的影响仅在厘米量级,而激光雷达的感知距离在几十米至几百米的范围,所以即使平移自由度的标定精度不高,导致的感知结果的偏差也非常微弱,因此对车辆感知的影响较小,可以采用默认标定值;翻滚角的偏差体现在物体的旋转方向,而对物体距离和方位的探测影响较弱。而俯仰角和横摆角对点云数据进行坐标系转换的影响较大,由于激光雷达的探测距离较远,探测距离与俯仰角/横摆角三角函数的乘积也较大,对于感知任务而言,即使俯仰角或横摆角的标定参数出现细微偏差,也会使得物体的探测距离和方位出现较大的偏差。本方案中为了时刻保证感知任务的准确,而在实时标定过程实时进行俯仰角和横摆角的标定。
在一个具体的实施例中,除俯仰角和横摆角之外的其他标定参数,可以通过线下标定的过程获得。如前所述,线下标定是在激光雷达系统安装到车辆上投入使用之前,车辆静止的情况下,基于固定的场景、标靶、摆阵器等实现对激光雷达设备的外部参数的标定。获得的标定参数主要是三个平移自由度以及翻滚角。
在另一个具体的实施例中,除俯仰角和横摆角之外的其他标定参数,可以通过默认值进行补充。
那么,在获得所有的标定参数之后,即可获得激光雷达坐标系与车辆前进坐标系之间的坐标变换矩阵。进而,可以利用该坐标变换矩阵实现将激光雷达采集的点云数据转换到车辆所在的车辆前进坐标系中。
例如,对于激光雷达坐标系中的空间点PL,可以利用变换矩阵将其转换为车辆前进坐标系中的空间点Pc。具体可以采用下述公式(1)和(2)来表示。
本发明中的标定方案,标定方法简单易于实现,标定过程中需要处理的数据量较小,且能够在车辆正常运行中进行实时标定,因此时刻保证了激光雷达到车辆坐标系的标定参数的精准,从而确保车辆利用激光雷达进行环境感知任务的正确精准。
本发明实施例通过对激光雷达坐标系到车辆前进坐标系的标定,使得标定过程能够在车辆正常行驶过程中完成,实现了标定的便捷性;此外,本发明中的标定过程不依赖惯性导航系统的精度,保证了标定参数的准确性和稳定性。
在本发明一个非限制性的实施例中,请参照图5,图5示出了一种激光雷达的标定方法。
在步骤501中,获取激光雷达的点云数据。具体可以是获取多帧点云数据,包括当前帧点云数据。
在步骤502中,判断车辆的行驶状态是否满足标定条件。如果是,则执行步骤504,否则执行步骤503。
在一种具体实施方式中,标定条件包括所述车辆基本处于直线行驶状态。也就是说,在车辆基本处于直行行驶状态时,可以进行激光雷达坐标系到车辆前进坐标系的标定。这是因为,在车辆直行时,前进方向和车辆前进坐标系的X轴重合,因此在车辆直行时即可实现激光雷达坐标系到车辆前进方向的标定。而直行是车辆正常行驶过程的非常常见的行驶状态,因此该标定条件极容易满足,因此本实施例中的标定方法可以在车辆的行驶过程中不断地执行,以实时保证激光雷达感知任务的精准。
更具体地,可以通过车辆的横摆角速度(yaw rate)来判断车辆是否处于直线行驶状态。车辆的横摆角速度可以通过激光雷达的点云数据获得,也可以通过车辆上安装的其他传感器(例如IMU)来获得。具体请参照图6,车辆行驶的横摆角速度小于第一门限阈值时确定车辆基本处于直线行驶状态。例如车辆行驶的横摆角速度小于1度/秒(°/s),表示车辆基本处于直线行驶状态。此时,车辆的前进方向D2与和车辆前进坐标系的X轴重合。
而车辆行驶的横摆角速度大于第一门限阈值时,车辆的前进方向D1与和车辆前进坐标系的X轴(图6中X1所示)存在一定的夹角,此时表示车辆未处于直线行驶状态。
在另一种具体实施方式中,标定条件包括车辆行驶的线速度超过第二门限阈值。车辆行驶的线速度可以通过激光雷达的点云数据获得,也可以通过车辆上安装的其他传感器(例如IMU)来获得。例如,车辆行驶的线速度(velocity)大于5米/秒(m/s)。也就是说,车辆行驶的线速度超过第二门限阈值时,可以进行激光雷达坐标系到车辆前进坐标系的标定。这是因为,车辆行驶的线速度超过第二门限阈值时,表示车辆运动较快,车载激光雷达的位姿具有明显变化,能够与激光雷达的测量误差产生的相对位姿进行区分,保证激光雷达标定的准确性。若车辆行驶的线速度小于第二门限阈值,则表明车辆运行速度过慢,激光雷达采集到的点云数据中的特征变化较少。而激光雷达坐标系到前进坐标系的标定需要用到两帧点云之间的相对姿态,点云数据中的特征变化较少的情况下,导致计算出的相对位姿无法区分是雷达测量误差造成的还是雷达运动造成的。因此本实施例中对车辆的运行速度进行了限定,以保证从点云数据中获取到的相对姿态信息是准确的。
在又一种具体实施方式中,标定条件包括所述车辆基本处于直线行驶状态,以及车辆行驶的线速度超过第二门限阈值。也就是说,在车辆基本处于直行行驶状态,且车辆行驶的线速度超过第二门限阈值时,可以进行激光雷达坐标系到车辆前进坐标系的标定。
在又一种具体实施方式中,标定条件包括车辆在一段时间内保持下述状态:基本处于直线行驶状态,且车辆行驶的线速度超过第二门限阈值。也就是说,在车辆基本处于直行行驶状态,且车辆行驶的线速度超过第二门限阈值持续一段时间的情况下,可以进行激光雷达坐标系到车辆前进坐标系的标定。通过此标定条件,可以确定车辆的直线、快速行驶状态并非极短时间内的偶然行为,例如车辆处于转弯过程中的一小段直线行驶过程。在车辆满足该标定条件后再启动标定,能够保证标定的正确性。此外,判断出车辆在持续进行直线行驶状态时,能够采用连续多帧的点云数据进行实时标定,进而可以对多帧点云的连续标定结果取平均值作为此次的标定值,或者判断连续多次标定值达到收敛值时将收敛值作为此次标定的标定值,从而进一步提高实时标定的准确性。
需要说明的是,车辆行驶线速度和横摆角速度可以通过点云里程计获得,也可以通过车辆的惯性测量单元(Inertial Measurement Unit,IMU)获得,如果通过IMU获得,由于是对车辆的行驶状态进行判断,所要求的IMU精度较低。
继续参照图5,在步骤503中,跳过当前帧点云数据。也就是说,如果不满足上述标定条件,则不采用当前帧点云数据进行实时标定,也即不采用该当前帧点云数据计算激光雷达的相对位姿。然后继续获取下一帧点云数据,再行判断车辆行驶状态是否满足标定条件。
在步骤504中,利用点云数据计算所述激光雷达的位姿变化,获得相对位姿。
在步骤505中,根据相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数。
具体实施中,车辆的行驶状态满足标定条件时,启动标定程序,也即执行步骤504和步骤505,以获得标定参数。
关于步骤504和步骤505的更多具体实现方式,请参照前述实施例,此处不再赘述。
在本发明一个非限制性的实施例中,在获取到点云数据时,还可以对点云数据进行筛选,以使得筛选后的点云数据具有较高的可靠性以及置信度,从而使得根据点云数据计算的激光雷达的相对位姿更加准确,进而使得激光雷达标定具有更高的准确性。
具体请参照图7,在步骤701中,获取激光雷达的点云数据。具体可以是获取多帧点云数据,包括当前帧点云数据。
在步骤702中,判断点云数据是否满足筛选条件,如果是,则执行步骤703,否则执行步骤704。
具体实施中,筛选条件包括以下一种或多种条件:
1、相邻两帧点云数据的时间差小于等于第三门限阈值。换言之,当前帧点云数据的时间值t1与上一帧点云数据的时间值t0,t1与t0之差不大于第三门限阈值。
2、前一帧点云数据的时间t0早于当前帧点云数据的时间t1。
3、利用点云数据计算激光雷达在相邻帧之间的移动线速度和角速度,且移动线速度差异小于等于第四门限阈值和角速度差异小于等于第五门限阈值。也就是说,激光雷达在相邻帧之间的移动线速度和角速度的差异较小。
4、点云数据中特定目标物体的特征数量大于等于第三门限阈值。
本实施例中,对于满足筛选条件的点云数据,在车辆的行驶状态满足标定条件时,可以用于实时标定,也即用于计算激光雷达的相对位姿。对于不满足筛选条件的点云数据,则跳过该帧点云数据,也即该帧点云数据不用于实时标定。
具体实施中,条件1和条件2是保证相邻两帧点云数据的时间连续性,避免发生点云数据时间采样或记录错误、点云丢帧、跳帧等问题。条件3则是确保激光雷达运动的连续性,如果通过点云数据判断激光雷达运动发生跳变,运动未保持连续,那么当前帧的点云数据则不可靠。因此,条件1、条件2和条件3是用于保证激光雷达的相邻两帧点云数据是可靠的,避免由于丢帧、记录错误等原因导致的标定错误。,具体地,在条件3中,计算激光雷达在相邻帧之间的移动线速度和角速度时,先根据上上帧点云数据与上一帧点云数据计算激光雷达的第一相对位姿,再根据上一点云数据与当前帧点云数据计算激光雷达的第二相对位姿;根据上述第一相对位姿和第二相对位姿计算激光雷达的移动线速度和角速度。
具体实施中,条件4则是确保点云数据中的特征数量,也即确保激光点云中柱状目标物体的特征数量足够多。因为点云数据中柱状目标物体的特征数量较多时,点云数据的置信度比较高,在标定过程中可以更准确地根据点云数据获得两帧点云的相对位姿,从而进行精准的标定。具体地,条件4中所称特定目标物体可以是固定柱状物体,例如可以是信号灯、电线杆等。
在步骤703中,判断车辆的行驶状态是否满足标定条件。如果是,则执行步骤705,否则执行步骤704。
在步骤704中,跳过当前帧点云数据。也就是说,不采用当前帧点云数据进行实时标定,也即不采用该当前帧点云数据计算激光雷达的相对位姿。
在步骤705中,利用满足筛选条件的点云数据计算所述激光雷达的位姿变化,获得相对位姿。
在步骤706中,根据相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数。
在本发明一个非限制性的实施例中,可以执行多次图3、图5或图7所示的实时标定过程,获得多个标定参数。对多个标定参数进行平均,以获得最终的标定结果。
本实施例中,标定结果的精度随标定次数增加而提高并收敛,因此可以通过进行多次标定来提高标定的精度。
请参照图8,图8示出了一种多次标定的标定参数随时间变化的示意图。具体实施中,在规定时间,例如100秒内进行多次标定。T1表示开始标定的时刻,T2表示第N次标定的时刻。若达到指定精度,表示标定参数趋于稳定,则输出收敛标志。其中,指定精度是指斜率趋近于零,也即标定参数在一定时间内的变化率为0。如图8所示,标定参数在T2时刻趋于稳定。经过实验证明,在趋于稳定后,标定参数的角度差异不超过0.05度。
车辆接收到收敛标志后可以存储此次标定结果,并在后续感知任务中使用该标定结果。如果未能在规定时间内达到指定精度,则不输出收敛标志,依旧沿用上次存储的标定结果。
测试数据显示,采用本发明的实时标定方案,即使车辆行驶在不同场景下进行实时标定时,标定参数的波动也在0.1度左右,标定参数具有稳定性。
在一个具体的应用场景中,表1示出了车辆在不同的场景中标定参数的示意值。
表1
场景 | 俯仰角(度) | 横摆角(度) |
城市场景 | 3.20 | 0.13 |
高速场景1 | 3.11 | 0.22 |
高速场景2 | 3.09 | 0.23 |
在步骤101或步骤301的一个具体实施例中,可以利用点云数据中的相邻两帧点云数据计算激光雷达的位姿变化,获得所述相对位姿。相对位姿包括旋转矩阵和平移向量(也可称为平移矩阵)。
具体地,利用第i-1帧点云数据和第i帧点云数据计算得到相对位姿也可以称为位姿矩阵,或者外参矩阵。位姿矩阵/>为4×4矩阵,其形式为/>其中,R表示大小为3×3的旋转矩阵,t表示平移向量,/>表示表示i-1时刻到i时刻激光雷达的平移向量。
具体地,位姿矩阵表示ti时刻激光雷达的位姿相对于ti-1时刻的位姿的相对变化。Ti时刻相对于ti-1时刻激光雷达的相对位姿可以通过ti时刻点云Li相对于起点时刻点云的位姿和ti-1时刻点云Li-1相对于起点时刻点云的位姿计算得到。ti时刻的点云Li和ti-1时刻的点云Li-1可以是直接相邻的两帧点云,也可以是间隔几帧的点云。
由于激光雷达和车辆固定连接,因此激光雷达的平移向量t也是车辆的平移向量,平移向量t的方向即车辆的前进方向,在车辆直行状态下,车辆的前进方向就是车辆前进坐标系的X轴方向,平移向量t表征车辆前进坐标系的X轴方向。
进一步地,在计算标定参数时,可以通过计算平移向量与激光雷达坐标系X轴的夹角确定激光雷达坐标系到车辆前进坐标系的标定参数。
如前所述,平移向量t表征车辆前进坐标系的X轴方向,那么平移向量t与激光雷达坐标系X轴方向的夹角即车辆前进坐标系X轴与雷达坐标系X轴的夹角。进而通过将该夹角转换成欧拉角俯仰角和横摆角,即可完成一次激光雷达坐标系到前进坐标系的标定。
具体地,可以采用以下方式计算上述夹角:对平移向量t进行归一化,获得第一单位向量;沿雷达坐标系X轴方向选取第二单位向量,并计算第一单位向量与所述第二单位向量的数量积,数量积为夹角的余弦值;对数量积进行反余弦运算,获得夹角。
进一步地,可以采用下述方式进行夹角与欧拉角的转换:计算第一单位向量与第二单位向量的向量积,获得第一单位向量与第二单位向量的旋转轴;利用旋转轴与夹角构建四元数;将四元数转换为欧拉角,获得俯仰角和横摆角。
需要说明的是,关于夹角的计算以及欧拉角的转换的具体过程可以参照已有技术,此处不再赘述。
关于本发明实施例的更多具体实现方式,请参照前述实施例,此处不再赘述。
请参照图9,本发明还公开了一种激光雷达的标定装置80。激光雷达的标定装置90包括:
获取模块901,用于获取激光雷达的点云数据;
位姿计算模块902,用于利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿;
标定参数计算模块903,用于根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,所述车辆前进坐标系X轴的方向为所述车辆直线行驶时的行驶方向,所述标定参数包括俯仰角和横摆角。
本发明实施例通过对激光雷达坐标系到车辆前进坐标系的标定,前进坐标系的方位可以容易地通过点云数据观测到,且不需要车辆进行特定轨迹的大角度转动,使得标定过程能够在车辆正常行驶过程中完成,实现了标定的便捷性;此外,本发明中的标定过程不依赖惯性导航系统的精度,保证了标定参数的准确性和稳定性。
在一个非限制性的实施例中,激光雷达的标定装置90还包括:判断模块,用于判断所述车辆的行驶状态是否满足标定条件,当车辆的行驶状态满足标定条件时,启动标定程序。
本发明实施例通过设置标定条件车辆基本处于直线行驶状态,使得车辆的实际行驶方向与车辆前进坐标系X轴的方向是重合的,当通过点云数据计算出车辆直线行驶时的行驶方向后,即可获知车辆的前进坐标系方位,从而保证激光雷达坐标系到车辆前进坐标系的正确标定;通过设置标定条件车辆行驶的线速度超过第二门限阈值,使得车载激光雷达的位姿具有明显变化,与激光雷达的测量误差产生的相对位姿进行区分,进一步保证激光雷达标定的准确性。
本发明中的标定方案,标定方法简单易于实现,标定过程中需要处理的数据量较小,且能够在车辆正常运行中进行实时标定,因此时刻保证了激光雷达到车辆坐标系的标定参数的精准,从而确保车辆利用激光雷达进行环境感知任务的正确精准。
在一个非限制性的实施例中,获取模块901包括获取单元,用于获取激光雷达的点云数据;筛选单元,用于在点云数据满足以下一种或多种条件时,选取点云数据,以用于计算相对位姿:相邻两帧点云数据的时间差小于等于第三门限阈值;相邻两帧点云数据中前一帧点云数据的时间早于相邻帧点云数据中当前帧点云数据的时间;利用点云数据计算激光雷达在相邻帧之间的移动线速度和角速度,且移动线速度差异小于等于第四门限阈值和角速度差异小于等于第五门限阈值;点云数据中特定目标物体的特征数量大于等于第三门限阈值。
本发明实施例利用一种或多种条件对点云数据进行筛选,并使用筛选后的点云数据计算激光雷达的相对位姿,使得筛选后的点云数据具有较高的可靠性以及置信度,从而使得激光雷达的相对位姿更加准确,进而使得激光雷达标定具有更高的准确性。
此外,可以采用连续多帧的点云数据进行实时标定,进而可以对多帧点云的连续标定结果取平均值作为此次的标定值,从而进一步提高实时标定的准确性。
在一个非限制性的实施例中,位姿计算模块902利用点云数据中的相邻两帧点云数据计算激光雷达的位姿变化,获得相对位姿。
在一个非限制性的实施例中,相对位姿包括旋转矩阵和平移向量;标定参数计算模块903通过计算所述平移向量与所述激光雷达坐标系水平轴的夹角确定所述激光雷达坐标系到所述车辆前进坐标系的标定参数。
在一个非限制性的实施例中,激光雷达的标定装置90还包括:标定结果确定模块,用于将多次标定获得的标定参数进行平均,以获得最终的标定结果。
本发明实施例通过判断连续多次标定值达到收敛值时将收敛值作为此次标定的标定值,从而进一步提高实时标定的准确性。
关于激光雷达的标定装置90的其他相关描述可以参照前述实施例中的相关描述,此处不再赘述。
关于上述实施例中描述的各个装置、产品包含的各个模块/单元,其可以是软件模块/单元,也可以是硬件模块/单元,或者也可以部分是软件模块/单元,部分是硬件模块/单元。例如,对于应用于或集成于芯片的各个装置、产品,其包含的各个模块/单元可以都采用电路等硬件的方式实现,或者,至少部分模块/单元可以采用软件程序的方式实现,该软件程序运行于芯片内部集成的处理器,剩余的(如果有)部分模块/单元可以采用电路等硬件方式实现;对于应用于或集成于芯片模组的各个装置、产品,其包含的各个模块/单元可以都采用电路等硬件的方式实现,不同的模块/单元可以位于芯片模组的同一组件(例如芯片、电路模块等)或者不同组件中,或者,至少部分模块/单元可以采用软件程序的方式实现,该软件程序运行于芯片模组内部集成的处理器,剩余的(如果有)部分模块/单元可以采用电路等硬件方式实现;对于应用于或集成于终端设备的各个装置、产品,其包含的各个模块/单元可以都采用电路等硬件的方式实现,不同的模块/单元可以位于终端设备内同一组件(例如,芯片、电路模块等)或者不同组件中,或者,至少部分模块/单元可以采用软件程序的方式实现,该软件程序运行于终端设备内部集成的处理器,剩余的(如果有)部分模块/单元可以采用电路等硬件方式实现。
本发明实施例还公开了一种存储介质,所述存储介质为计算机可读存储介质,其上存储有计算机程序,所述计算机程序运行时可以执行图1、图3中或图4所示方法的步骤。所述存储介质可以包括只读存储器(Read-Only Memory,ROM)、随机存取存储器(RandomAccess Memory,RAM)、磁盘或光盘等。存储介质还可以包括非挥发性存储器(non-volatile)或者非瞬态(non-transitory)存储器等。
应理解,本文中术语“和/或”,仅仅是一种描述关联对象的关联关系,表示可以存在三种关系,例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B这三种情况。另外,本文中字符“/“,表示前后关联对象是一种“或”的关系。
本发明实施例中出现的“多个”是指两个或两个以上。
本发明实施例中出现的第一、第二等描述,仅作示意与区分描述对象之用,没有次序之分,也不表示本发明实施例中对设备个数的特别限定,不能构成对本发明实施例的任何限制。
本发明实施例中出现的“连接”是指直接连接或者间接连接等各种连接方式,以实现设备间的通信,本发明实施例对此不做任何限定。
上述实施例,可以全部或部分地通过软件、硬件、固件或其他任意组合来实现。当使用软件实现时,上述实施例可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令或计算机程序。在计算机上加载或执行所述计算机指令或计算机程序时,全部或部分地产生按照本发明实施例所述的流程或功能。所述计算机可以为通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一个计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线或无线方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集合的服务器、数据中心等数据存储设备。
在本发明所提供的几个实施例中,应该理解到,所揭露的方法、装置和系统,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的;例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式;例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理包括,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用硬件加软件功能单元的形式实现。
上述以软件功能单元的形式实现的集成的单元,可以存储在一个计算机可读取存储介质中。上述软件功能单元存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的部分步骤。
虽然本发明披露如上,但本发明并非限定于此。任何本领域技术人员,在不脱离本发明的精神和范围内,均可作各种更动与修改,因此本发明的保护范围应当以权利要求所限定的范围为准。
Claims (13)
1.一种激光雷达的标定方法,其特征在于,包括:
获取激光雷达的点云数据;
利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿;
根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,所述车辆前进坐标系X轴的方向为所述车辆直线行驶时的行驶方向,所述标定参数包括俯仰角和横摆角。
2.根据权利要求1所述的激光雷达的标定方法,其特征在于,所述利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿之前,还包括:
判断所述车辆的行驶状态是否满足标定条件,当车辆的行驶状态满足所述标定条件时,启动标定程序。
3.根据权利要求2所述的激光雷达的标定方法,其特征在于,所述标定条件包括所述车辆基本处于直线行驶状态。
4.根据权利要求3所述的激光雷达的标定方法,其特征在于,当所述车辆行驶的横摆角速度小于第一门限阈值时确定所述车辆基本处于直线行驶状态。
5.根据权利要求3所述的激光雷达的标定方法,其特征在于,所述标定条件还包括所述车辆行驶的线速度超过第二门限阈值。
6.根据权利要求5所述的激光雷达的标定方法,其特征在于,所述标定条件包括车辆基本处于直线行驶状态和所述线速度超过第二门限阈值的持续时长达到门限时长。
7.根据权利要求1所述的激光雷达的标定方法,其特征在于,所述获取激光雷达的点云数据,具体包括:
获取所述激光雷达的点云数据;
所述点云数据满足以下一种或多种条件时,选取所述点云数据,以用于计算所述相对位姿:
相邻两帧点云数据的时间差小于等于第三门限阈值;
相邻两帧点云数据中前一帧点云数据的时间早于所述相邻帧点云数据中当前帧点云数据的时间;
利用所述点云数据计算所述激光雷达在相邻帧之间的移动线速度和角速度,且所述移动线速度差异小于等于第四门限阈值和角速度差异小于等于第五门限阈值;
所述点云数据中特定目标物体的特征数量大于等于第三门限阈值。
8.根据权利要求1所述的激光雷达的标定方法,其特征在于,所述利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿,具体包括:
利用所述点云数据中的相邻两帧点云数据计算所述激光雷达的位姿变化,获得所述相对位姿。
9.根据权利要求1所述的激光雷达的标定方法,其特征在于,所述相对位姿包括旋转矩阵和平移向量;
所述根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,具体包括:
通过计算所述平移向量与所述激光雷达坐标系水平轴的夹角确定所述激光雷达坐标系到所述车辆前进坐标系的标定参数。
10.根据权利要求1所述的激光雷达的标定方法,其特征在于,还包括:
将多次标定获得的标定参数进行平均,以获得最终的标定结果。
11.一种激光雷达的标定装置,其特征在于,包括:
获取模块,用于获取激光雷达的点云数据;
位姿计算模块,用于利用所述点云数据计算所述激光雷达的位姿变化,获得相对位姿;
标定参数计算模块,用于根据所述相对位姿计算激光雷达坐标系到车辆前进坐标系的标定参数,所述车辆前进坐标系X轴的方向为所述车辆直线行驶时的行驶方向,所述标定参数包括俯仰角和横摆角。
12.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被计算机运行时执行权利要求1至9中任一项激光雷达的标定方法的步骤。
13.一种终端设备,包括存储器和处理器,所述存储器上存储有可在所述处理器上运行的计算机程序,其特征在于,所述处理器运行所述计算机程序时执行权利要求1至9中任一项激光雷达的标定方法的步骤。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211435761.0A CN118050707A (zh) | 2022-11-16 | 2022-11-16 | 激光雷达的标定方法及装置、存储介质、终端设备 |
PCT/CN2023/131990 WO2024104418A1 (en) | 2022-11-16 | 2023-11-16 | Calibration method for lidar and calibration apparatus, storage medium, and terminal device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211435761.0A CN118050707A (zh) | 2022-11-16 | 2022-11-16 | 激光雷达的标定方法及装置、存储介质、终端设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN118050707A true CN118050707A (zh) | 2024-05-17 |
Family
ID=91050628
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211435761.0A Pending CN118050707A (zh) | 2022-11-16 | 2022-11-16 | 激光雷达的标定方法及装置、存储介质、终端设备 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN118050707A (zh) |
WO (1) | WO2024104418A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118393471B (zh) * | 2024-06-28 | 2024-10-11 | 北京城建智控科技股份有限公司 | 列车定位校准方法、装置和电子设备 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150362587A1 (en) * | 2014-06-17 | 2015-12-17 | Microsoft Corporation | Lidar sensor calibration using surface pattern detection |
CN110673115B (zh) * | 2019-09-25 | 2021-11-23 | 杭州飞步科技有限公司 | 雷达与组合导航系统的联合标定方法、装置、设备及介质 |
US20210373138A1 (en) * | 2020-05-29 | 2021-12-02 | GM Global Technology Operations LLC | Dynamic lidar alignment |
CN112698302B (zh) * | 2020-12-16 | 2023-11-07 | 南京航空航天大学 | 一种颠簸路况下的传感器融合目标检测方法 |
-
2022
- 2022-11-16 CN CN202211435761.0A patent/CN118050707A/zh active Pending
-
2023
- 2023-11-16 WO PCT/CN2023/131990 patent/WO2024104418A1/en unknown
Also Published As
Publication number | Publication date |
---|---|
WO2024104418A1 (en) | 2024-05-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10634777B2 (en) | Radar odometry for vehicle | |
CN110178048B (zh) | 交通工具环境地图生成和更新的方法和系统 | |
US10436884B2 (en) | Calibration of laser and vision sensors | |
CN110673115B (zh) | 雷达与组合导航系统的联合标定方法、装置、设备及介质 | |
US11279045B2 (en) | Robot pose estimation method and apparatus and robot using the same | |
US9659378B2 (en) | Point cloud position data processing device, point cloud position data processing system, point cloud position data processing method, and program therefor | |
CN107481292B (zh) | 车载摄像头的姿态误差估计方法和装置 | |
US20190259176A1 (en) | Method and device to determine the camera position and angle | |
CN110501712B (zh) | 无人驾驶中用于确定位置姿态数据的方法、装置和设备 | |
KR20180044279A (ko) | 깊이 맵 샘플링을 위한 시스템 및 방법 | |
CN110889808A (zh) | 一种定位的方法、装置、设备及存储介质 | |
JP7155284B2 (ja) | 計測精度算出装置、自己位置推定装置、制御方法、プログラム及び記憶媒体 | |
CN113933818A (zh) | 激光雷达外参的标定的方法、设备、存储介质及程序产品 | |
CN113959457B (zh) | 一种自动驾驶车辆的定位方法、装置、车辆和介质 | |
CN114019954B (zh) | 航向安装角标定方法、装置、计算机设备和存储介质 | |
KR20160120467A (ko) | 차량용 2차원 레이더의 방위각 보정 장치 및 방법 | |
WO2024104418A1 (en) | Calibration method for lidar and calibration apparatus, storage medium, and terminal device | |
JP2014240266A (ja) | センサドリフト量推定装置及びプログラム | |
CN114694111A (zh) | 车辆定位 | |
US20160034607A1 (en) | Video-assisted landing guidance system and method | |
CN116182905A (zh) | 激光雷达和组合惯导的时空外参标定方法、装置及系统 | |
US20220404170A1 (en) | Apparatus, method, and computer program for updating map | |
CN112578363B (zh) | 激光雷达运动轨迹获取方法及装置、介质 | |
CN107796417B (zh) | 一种自适应估计景象匹配与惯导安装误差的方法 | |
CN112649815B (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 |