CN114636993A - 一种激光雷达与imu的外参标定方法、装置及设备 - Google Patents
一种激光雷达与imu的外参标定方法、装置及设备 Download PDFInfo
- Publication number
- CN114636993A CN114636993A CN202011492455.1A CN202011492455A CN114636993A CN 114636993 A CN114636993 A CN 114636993A CN 202011492455 A CN202011492455 A CN 202011492455A CN 114636993 A CN114636993 A CN 114636993A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- point cloud
- cloud data
- optimized
- imu
- 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
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
-
- 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
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Abstract
本申请公开了一种激光雷达与IMU的外参标定方法、装置及设备,用于解决现有技术中帧间匹配算法不适用于倾斜安装的激光雷达的外参标定的问题。标定装置根据待优化的外参值,将激光雷达采集的点云数据转换至IMU坐标系;根据IMU坐标系与参考坐标系的之间的相对转换关系,将点云数据从IMU坐标系转换至参考坐标系;根据参考坐标系下的点云数据对待优化的外参值进行迭代调整,从而得到目标外参值,避免外参标定结果受激光雷达的安装角度的影响,实现自动化标定,提高外参标定效率。
Description
技术领域
本申请实施例涉及自动驾驶技术领域,尤其涉及一种激光雷达与IMU的外参标定方法、装置及设备。
背景技术
高精度地图是实现无人驾驶车辆车道级别导航与监控的地理信息数据的基础和必要条件。高精度地图主要依赖于惯性测量单元(inertial measuring unit,IMU)、卫星导航系统(global navigation satellite system,GNSS)、激光雷达等传感器进行采集制作。为了将不同传感器的数据在同一个坐标系中表示,需要对不同传感器之间的外参值进行标定。
目前,采集车辆上的激光雷达通常平行车顶安装,在进行标定时,利用激光雷达扫描到的相邻两帧的共同特征物的点云数据,采用帧间匹配算法,例如迭代最近点(iterative closest point,ICP)算法计算采集车辆的位姿变化,得到激光雷达的轨迹,进而结合组合导航系统,给出IMU的轨迹。然后,采用最小二乘法即可完成激光雷达相对IMU的外参标定。
然而,为提高地面特征识别准确度,在采集高精度地图时,采集车辆中的雷达可以倾斜安装,但倾斜安装的激光雷达在单位时间内扫描到的特征物范围缩小,能够扫描到的特征物主要为地面、车辆两侧和车顶斜上方的特征物,而采集车辆前方的特征物不能被扫描到,从而导致相邻帧间扫描到的特征物减少,使得帧间匹配误差较大,影响外参标定准确率。
发明内容
本申请实施例提供一种激光雷达与IMU的外参标定方法、装置及设备,用于解决现有技术中帧间匹配算法不适用于倾斜安装的激光雷达的外参标定的问题。
第一方面,本申请实施例提供一种激光雷达与IMU的外参标定方法,应用于标定装置,所述激光雷达与所述IMU均固定安装于待标定车辆上,所述方法包括:
获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;
根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据;所述第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的待标定车辆的位置和姿态获得的;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
通过上述设计,标定装置将激光雷达采集的点云数据,从激光雷达坐标系转换至参考坐标系,根据参考坐标系下的点云数据对待优化的外参值进行迭代优化,直至当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,避免受激光雷达的安装角度的影响导致外参标定结果的准确率、效率低,实现自动化外参标定,提高外参标定效率和准确率。
一种可能的设计中,所述第一点云数据是所述激光雷达在N个第一采集时刻采集的,获取所述IMU坐标系与所述参考坐标系的第二相对转换关系,包括:获取所述IMU在M个第二采集时刻采集的测量数据,所述测量数据包括所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的线加速度和角速度;根据所述测量数据,得到分别在M个第二采集时刻的第二相对转换关系,所述第二采集时刻的第二相对转换关系用于表征在所述第二采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系。
通过上述设计,标定装置根据IMU采集的代标定车辆的线加速度和角速度,得到分别在M个第二采集时刻,IMU坐标系和参考坐标系的相对转换关系,提高外参标定准确率。
一种可能的设计中,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据,包括:根据分别在M个第二采集时刻的第二相对转换关系,获得分别在所述N个第一采集时刻的第三相对转换关系,所述第一采集时刻的第三相对转换关系用于表征在所述第一采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系;根据第i个第一采集时刻的第三相对转换关系,分别将第i个第一采集时刻的第二点云数据,转换到所述参考坐标系,得到第i个第一采集时刻的点云数据,i取遍小于或者等于N的正整数,以得到N个第一采集时刻的点云数据构成所述第三点云数据。
通过上述设计,标定装置根据分别在M个第二采集时刻,IMU坐标系和参考坐标系的相对转换关系,可以得到分别在N个第一采集时刻,IMU坐标系和参考坐标系的相对转换关系,实现将N个第一采集时刻的第二点云数据,从IMU坐标系转换到参考坐标系,提高激光雷达与IMU的外参标定效率和准确率。
一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数之和,判断待优化的外参值能否使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件,也可以理解为待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中重叠或基本重叠,提高外参标定效率,同时对第一次待优化的外参值(即初始外参值)不敏感,收敛性好。
一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数,判断待优化的外参值能否使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件,提高外参标定准确率,且对初始外参值不敏感,收敛性好,提高外参标定效率。
一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数之和,以及根据相邻两次调整中的待优化的外参值,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,同时保证外参标定准确率和标定效率。
一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数,以及根据相邻两次调整中的待优化的外参值,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,同时保证外参标定准确率和标定效率。
一种可能的设计中,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据,包括:根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据从所述IMU坐标系转换为所述参考坐标系,得到第四点云数据;将运动补偿后的第四点云数据作为所述第三点云数据,所述运动补偿后的第四点云数据是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置、姿态和速度进行的运动补偿。
通过上述设计,根据待标定车辆的位姿和速度,对点云数据进行运动补偿,消除车体运动带来的运动误差,提高外参标定准确率。
第二方面,本申请实施例提供一种激光雷达与IMU的外参标定方法,应用于标定装置,所述激光雷达与所述IMU均固定安装于待标定车辆上。所述方法包括:
获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
通过上述设计,标定装置可以在获取到激光雷达采集的点云数据后,将点云数据从激光雷达坐标系转换到IMU坐标系,直接根据IMU坐标系下的点云数据,对待优化的外参值进行迭代调整,直至当前次调整使用的待优化的外参值能够使得激光雷达行驶到不同的位置采集的同一特征物在IMU坐标系中重叠或部分重叠,避免外参标定结果受激光雷达的安装角度的影响,提高激光雷达的外参标定效率和准确率。
一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数之和,判断待优化的外参值能否使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件,提高外参标定效率。
一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数,判断待优化的外参值能否使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件,提高外参标定准确率。
一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数之和,以及根据相邻两次调整中的待优化的外参值,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,同时保证外参标定准确率和标定效率。
一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
通过上述设计,根据X个特征物的误差参数,以及根据相邻两次调整中的待优化的外参值,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,同时保证外参标定准确率和标定效率。
第三方面,本申请实施例提供一种激光雷达与IMU的外参标定方法,应用于标定装置,所述激光雷达与所述IMU均固定安装于待标定车辆上。所述方法包括:获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;在当前次调整中,根据待优化的外参值,以及根据IMU坐标系与参考坐标系的第二相对转换关系,得到激光雷达坐标系与参考坐标系的第四相对转换关系,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系,所述IMU坐标系与参考坐标系的第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置和姿态获得的;根据所述激光雷达坐标系与所述参考坐标系的第四相对转换关系,将所述第一点云数据从所述激光雷达坐标系转换到所述参考坐标系得到第二点云数据;根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
通过上述设计,标定装置可以在获取到激光雷达采集的点云数据后,将点云数据从激光雷达坐标系直接转换到参考坐标系,根据参考坐标系下的点云数据,对待优化的外参值进行迭代调整,直至当前次调整使用的待优化的外参值能够使得激光雷达行驶到不同的位置采集的同一特征物在IMU坐标系中重叠或部分重叠,避免外参标定结果受激光雷达的安装角度的影响,提高激光雷达的外参标定效率和准确率。
第四方面,本申请实施例提供一种激光雷达与IMU的外参标定方法,该方法可以由标定装置或标定装置中的芯片或芯片系统来执行,以实现上述第一方面、第二方面或第三方面中标定装置执行的任一种可能实现方式中的方法。
第五方面,本申请提供一种激光雷达与IMU的外参标定装置,该标定装置包括执行上述第一方面、第二方面或第三方面中任一种可能实现方式中的方法的模块/单元。这些模块/单元可以通过硬件实现,也可以通过硬件执行相应的软件实现。
第六方面,本申请提供一种标定装置,包括处理器和存储器,其中,存储器用于存储一个或多个计算机程序;当存储器存储的一个或多个计算机程序被处理器执行时,使得该标定装置能够实现上述第一方面、第二方面或第三方面中任一种可能实现方式中的方法。
第七方面,本申请提供一种计算机程序,当所述计算机程序在计算机上运行时,使得所述计算机执行上述第一方面、第二方面或第三方面中任一种可能实现方式中的方法。
第八方面,本申请提供一种计算机可读存储介质,所述计算机可读存储介质中存储有计算机程序,当所述计算机程序被计算机执行时,使得所述计算机执行上述第一方面、第二方面或第三方面中任一种可能实现方式中的方法。
第九方面,本申请提供一种芯片,所述芯片用于读取存储器中存储的计算机程序,执行上述第一方面、第二方面或第三方面中任一种可能实现方式中的方法。
第十方面,本申请实施例还提供一种芯片系统,该芯片系统包括处理器,用于支持计算机装置实现上述第一方面、第二方面或第三方面中任一种可能实现方式中的方法。在一种可能的设计中,所述芯片系统还包括存储器,所述存储器用于保存该计算机装置必要的程序和数据。该芯片系统可以由芯片构成,也可以包含芯片和其他分立器件。
上述第四方面至第十方面中任一可能的技术方案可以达到的技术效果请参照上述第一方面、第二方面或第三方面中任一种可能实现方式中的方法可以达到的技术效果描述,这里不再重复赘述。
附图说明
图1为本申请实施例中提供的一种可能的标定场景示意图;
图2为本申请实施例中提供的一种可能的激光雷达与采集车辆之间的位置示意图;
图3A为本申请实施例中提供的一种可能的标定场地示意图;
图3B为本申请实施例中提供的另一种可能的标定场地示意图;
图4为本申请实施例中提供的一种可能的采集路线示意图;
图5为本申请实施例中提供的第一种可能的激光雷达与IMU的外参标定方法的流程示意图;
图6为本申请实施例中提供的一种可能的激光雷达与IMU的外参标定方法的流程示意图;
图7为本申请实施例中提供的另一种可能的激光雷达与IMU的外参标定方法的流程示意图;
图8为本申请实施例中提供的第二种可能的激光雷达与IMU的外参标定方法的流程示意图;
图9为本申请实施例中提供的第三种可能的激光雷达与IMU的外参标定方法的流程示意图;
图10为本申请实施例中提供的一种可能的标定装置的结构示意图;
图11为本申请实施例中提供的另一种可能的标定装置的结构示意图。
具体实施方式
为了使本申请更容易被理解,下面首先对本申请实施例涉及的一些基本概念进行解释。需要说明的是,这些解释是为了让本申请实施例更容易被理解,而不应该视为对本申请所要求的保护范围的限定。
1、公共坐标系。
公共坐标系,又称为世界坐标系或者全局坐标系,其坐标原点是空间中一个固定不变的点。公共坐标系是绝对坐标系,空间中所有物体都可以公共坐标系为基准来确定该物体的位置。示例性的,公共坐标系可以是以东、北、天为X轴、Y轴、Z轴的世界坐标系。
2、外参。
通常,影响激光雷达性能的参数分为两种:内参和外参。内参在激光雷达制造时即确定,内参可以包括但不限于每束激光水平和垂直的角度以及距离校正值等。外参是指激光雷达相对于IMU的偏移距离和偏移角度。比如,激光雷达相对于IMU的偏移距离是指,将激光雷达看成一个质点,该质点在IMU坐标系O-x1y1z1下的坐标(x,y,z)即可指示激光雷达相对于IMU的偏移距离;再比如,以激光雷达的质心为原点建立激光雷达坐标系O-x2y2z2,假设将激光雷达坐标系O-x2y2z2,绕x2轴、y2轴和z2轴分别旋转θ1、θ2和θ3这三个角度后,x1轴与x2轴在三维空间中的方向相同、y1轴与y2轴在三维空间中的方向相同,且z1轴与z2轴在三维空间中的方向相同,那么,θ1、θ2和θ3可视为激光雷达相对于IMU的偏移角度。
图1为本申请实施例中提供的一种可能的标定场景示意图,包含采集车辆(采集车辆也可称为待标定车辆)、激光雷达和IMU,激光雷达和IMU均固定安装于采集车辆上。采集车辆按照采集路线进行行驶的过程中,激光雷达可获取采集路线周围的特征物的点云数据,IMU可获取采集车辆的线加速度和角速度。示例性的,该采集车辆中还包含卫星导航系统(global navigation satellite system,GNSS),GNSS用于实现激光雷达与IMU之间的时钟同步,以及提供公共坐标系下采集车辆的三维位置。
图2为本申请实施例中提供的一种可能的激光雷达与采集车辆之间的位置示意图,激光雷达与采集车辆之间的倾斜角为设定角度,作为一种示例,激光雷达倾斜安装于采集车辆,即倾斜角为第一设定角度,比如,第一设定角度可以为32°。在采集高精度地图的过程中,当采集车辆按照采集路线行驶时,倾斜安装的激光雷达的反射强度更高,获取到的路面点云密集,提高路面高精度地图的采集效率和精度。作为另一种示例,激光雷达也可以平行安装于采集车辆,即倾斜角为第二设定角度,比如,第二设定角度可以为1°。
下面结合附图对本申请实施例中的数据采集要求进行说明。
1)标定场地要求:参阅图3A、图3B所示,以采集车辆顶部设置的卫星导航天线为中心,将半径R米,仰角α度以上,无遮挡物的场地作为标定场地。例如,以车辆顶部设置的卫星导航天线为中心,将半径20米,仰角45度以上,无遮挡物的场地作为标定场地。示例性的,卫星导航接收设备的收星数大于30颗,定位精度衰减因子(PDOP)值小于1.5,以保证获取到的采集车辆在公共坐标系下的位置更加准确,提高测量精度。其中,卫星导航天线和卫星导航接收设备均为GNSS中的设备。
2)特征物要求:特征物包括平面特征物和高空特征物。其中,平面特征物可以为设定面积的平整地面,比如,平面特征物为1平方的地面,该1平方的地面相对平整,无上坡和坑洼。高空特征物为距离地面的高度达到设置高度的物体,比如,高空特征物可以是距离地面3米的路灯的灯头,又比如,高空特征物可以是距离地面3米的指示牌。
3)采集路线要求:比如,采集车辆可以在行驶过程中正反向经过同一特征物,再比如,采集车辆行驶过程中激光雷达可以多次扫描到特征物。采集路线也可称为目标路径。参阅图4所示,图4中包含地面、路灯的灯头两个特征物,L1、L2、L3、L4为不同的行驶路线,采集车辆的采集路线可以为A→L1→B→L2→C→A→L3→B→L4→C→L4→B→L3→A→C→L2→B→L1→A。进一步的,为提高外参标定的精度和准确度,当采集车辆沿采集路线进行数据采集时,采集车辆的行驶速度小于设定阈值,比如,采集车辆的行驶速度小于10km/h。
当采集车辆按照采集路线在标定场地中行驶时,激光雷达采集特征物的点云数据,IMU获取采集车辆的线加速度和角速度。在进行外参标定时,标定装置可以根据待优化的外参值,将激光雷达采集的点云数据转换至IMU坐标系;根据IMU采集的采集车辆的线加速度和角速度,得到IMU坐标系与参考坐标系的之间的相对转换关系;根据IMU坐标系与参考坐标系的之间的相对转换关系,将点云数据从IMU坐标系转换至参考坐标系;根据参考坐标系的点云数据对待优化的外参值进行调整,从而得到目标外参值。通过将激光雷达采集的点云数据转换至参考坐标系,基于参考坐标系下的点云数据对待优化的外参值进行优化调整,实现自动化标定,提高外参标定效率。
下面结合附图介绍本申请实施例提供的技术方案。
参阅图5所示,图5为本申请实施例中提供的一种可能的激光雷达与IMU的外参标定方法,该方法可由标定装置执行,也可以由标定装置中的芯片或芯片系统执行。下文中,以S501-S504的执行主体为标定装置为例。
S501、标定装置获取激光雷达采集的第一点云数据,该第一点云数据用于表征采集车辆行驶在目标路径上采集的特征物在激光雷达坐标系中的位置。下文中,将激光雷达坐标系简称为雷达坐标系。
第一点云数据包括激光雷达在N个采集时刻采集到的N帧点云数据。
第一点云数据可以是根据数据采集阶段激光雷达采集的激光雷达数据得到的,该激光雷达数据包括激光雷达的反射强度、扫描角度和扫描方向等中的任一项或多项。在采集车辆进行数据采集的过程中,激光雷达采集激光雷达数据。在进行激光雷达与IMU的外参标定时,标定装置可以根据内参,对激光雷达数据进行解析,得到激光雷达采集的第一点云数据。示例性的,第一点云数据可以采用点云数据(point cloud data,PCD)格式进行存储。示例性的,数据采集过程中,激光雷达采集到激光雷达数据之后,可以将采集到的激光雷达数据存储到存储区域中。进一步的,在进行外参标定时,标定装置可以从存储区域中获取到激光雷达数据。
S502、标定装置在当前次调整中,根据待优化的外参值,将第一点云数据从激光雷达坐标系转换为IMU坐标系,得到第二点云数据,待优化的外参值用于指示激光雷达坐标系和IMU坐标系之间的第一相对转换关系。
第一次调整中的待优化的外参值也可以称为初始外参值,初始外参值包括雷达坐标系和IMU坐标系之间的偏移距离,和\或,雷达坐标系和IMU坐标系之间的偏移角度。初始外参值可以是根据IMU和激光雷达在采集车辆中的安装位置预估得到的。
标定装置可以根据初始外参值,对第一点云数据进行直角坐标变换,将第一点云数据从雷达坐标系转换到IMU坐标系。示例性的,标定装置根据初始外参值中包含的偏移距离,对第一点云数据进行位移变换,以及根据初始外参值中包含的偏移角度,对第一点云数据进行转轴变换,得到IMU坐标系下的第二点云数据。
S503、标定装置根据IMU坐标系与参考坐标系的第二相对转换关系,将第二点云数据转换到参考坐标系得到第三点云数据,IMU坐标系与参考坐标系的相对转换关系是根据采集车辆行驶在目标路径的过程中IMU采集的采集车辆的位置和姿态获得的。
其中,IMU坐标系与参考坐标系的第二相对转换关系可以是标定装置通过以下方式获取的:标定装置获取IMU在M个第二采集时刻采集的测量数据,测量数据包括采集车辆行驶在目标路径的过程中IMU采集的采集车辆的线加速度和角速度;根据测量数据,得到分别在M个第二采集时刻的第二相对转换关系,第二采集时刻的第二相对转换关系用于表征在第二采集时刻,IMU坐标系与参考坐标系之间的相对转换关系。
标定装置根据分别在M个第二采集时刻的第二相对转换关系,获得分别在N个第一采集时刻的第三相对转换关系,第一采集时刻的第三相对转换关系用于表征在第一采集时刻,IMU坐标系与参考坐标系之间的相对转换关系;根据第i个第一采集时刻的第三相对转换关系,分别将第i个第一采集时刻的第二点云数据,转换到参考坐标系,得到第i个第一采集时刻的点云数据,i取遍小于或者等于N的正整数,以得到N个第一采集时刻的点云数据构成所述第三点云数据。
示例性的,标定装置根据分别在M个第二采集时刻的第二相对转换关系,获得分别在N个第一采集时刻的第三相对转换关系的过程中,以单帧点云数据为例,单帧点云数据为第二点云数据中的任意一帧点云数据。作为一种可能的情况,M个第二采集时刻中存在单帧点云数据的采集时刻,根据分别在M个第二采集时刻的IMU坐标系与参考坐标系之间的相对转换关系,直接获得在单帧点云数据的采集时刻的第三相对转换关系,即获得在单帧点云数据的采集时刻的IMU坐标系与参考坐标系之间的相对转换关系。
作为另一种可能的情况,M个第二采集时刻中不存在单帧点云数据的采集时刻,标定装置可以根据分别在M个第二采集时刻的第二相对转换关系,采用插值算法,获得单帧点云数据的采集时刻的第三相对转换关系。插值算法可以采用线性插值算法、抛物线插值算法、拉格朗日插值算法、牛顿插值算法中的任一项。插值算法可以根据采集车辆的运动变化剧烈程度、设定的插值精度、设定的计算实时性要求等中的一项或多项进行选择。
作为一种可能的实施方式,参考坐标系可以是指公共坐标系。当参考坐标系为公共坐标系时,IMU坐标系与公共坐标系的第二相对转换关系的确定方式,具体参见实施例一。
作为另一种可能的实施方式,参考坐标系也可以是指局部坐标系,局部坐标系包括固定时刻的雷达坐标系、固定时刻的IMU坐标系或者自定义坐标系,比如,0秒(s)时刻的雷达坐标系,再比如,0s时刻的IMU坐标系。当参考坐标系为局部坐标系时,IMU坐标系与局部坐标系的第二相对转换关系的确定方式,具体参见实施例二。
示例性的,采集时刻可以采用GNSS时间表示。在采集车辆进行数据采集前,可以通过GNSS对IMU和激光雷达进行时钟同步。示例性的,GNSS可以将GNSS秒脉冲信号和推荐最小数据量的全球定位系统(global positioning system,GPS)信息(GPRMC)数据帧输入到激光雷达相应的数据接口,激光雷达接收到GNSS秒脉冲信号后,根据GPRMC数据帧中包含的标准时间,对激光雷达的时钟进行校准。完成IMU与激光雷达的时间同步后,IMU和激光雷达均可以将数据的采集时刻转换成GNSS时间。
S504、标定装置根据第三点云数据,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
作为一种可能的实现方式,第三点云数据用于表征X个特征物在参考坐标系的三维坐标,X为正整数。标定装置直接根据第三点云数据,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
作为另一种可能的实现方式,为了提高标定效率及标定准确率,标定装置获取到第三点云数据后,还可以对第三点云数据进行特征物提取。进一步的,标定装置根据提取出的各个特征物的特征点云集合,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
示例性的,若标定场地中存在X个特征物,标定装置根据X个参考坐标范围,从第三点云数据中,提取出X个特征点云集合,X个参考坐标范围为X个特征物在参考坐标系中的参考坐标范围。作为一种举例,标定装置对参考坐标系下的第三点云数据,先进行点云拼接,再进行特征物提取。示例性的,标定装置对参考坐标系下的第三点云数据中包含的N帧点云数据进行点云拼接,得到拼接后的第三点云数据;对拼接后的第三点云数据进行特征物提取,得到X个特征物的特征点云集合。其中,点云拼接是指将不同角度不同时间点采集到的数据统一到同一个坐标系下的过程。例如,第三点云数据中包含点云数据1、点云数据2和点云数据3,标定装置对点云数据1、点云数据2和点云数据3进行点云拼接后,得到拼接后的第三点云数据。标定场地中包含特征物A,根据特征物A的参考坐标范围,从拼接后的第三点云数据中,提取出特征物A的特征点云集合。
作为另一种举例,标定装置对参考坐标系下的第三点云数据,先进行特征物提取,再进行点云拼接。示例性的,标定装置对参考坐标系下的第三点云数据中包含的N帧点云数据分别进行特征物提取,得到X个特征物的各帧特征数据;分别针对X个特征物,对相应的N帧特征数据进行点云拼接,得到拼接后的第三点云数据。以第三点云数据中包含的点云数据1为例,标定装置可以根据各个特征物的参考坐标范围,针对单帧点云数据进行特征物提取,参考坐标范围的测量精度可以为米级。标定场地中包含特征物A,标定装置根据特征物A的参考坐标范围,在参考坐标系下,从点云数据1中,提取出特征物A的参考坐标范围内的点云数据,作为特征物A的一帧特征点云。在参考坐标系下,采用上述单帧点云数据中的特征物提取方法,对第三点云数据中包含的N帧点云数据进行特征物提取,可以得到特征物A的N帧特征点云,对特征物A的N帧特征点云进行点云拼接,可以得到特征物A的特征点云集合。
示例性的,标定装置可以通过但不限于以下两种可能的实现方式,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件:
第一种可能的实现方式:标定装置确定满足第一迭代停止条件时,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件。
示例性的,标定装置根据提取出的各个特征物的特征点云集合,采用迭代优化算法,对待优化的外参值进行调整,直至满足第一迭代停止条件时,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件。迭代优化算法可以采用但不限于高斯牛顿法、共轭梯度法、梯度下降法等中的任一项。
标定装置采用迭代优化算法时,将误差参数作为目标函数,将待优化的外参值作为优化变量。标定装置可以根据各个特征物的特征点云集合,计算得到各个特征物的误差参数。其中,一个特征物的误差参数用于表示一个特征物在参考坐标系的三个维度的坐标分别对应的方差之和。
第一迭代停止条件可以采用但不限于固定迭代次数法、固定时间法、前后作差法中的任一项。固定循环次数法是指迭代次数达到次数门限时停止迭代。固定时间法是指迭代时长达到时长门限时停止迭代。
当采用前后作差法时,作为一种示例,第一迭代停止条件可以是当前次迭代中X个特征物的误差参数与上一次迭代中X个特征物的误差参数的差值均小于第二门限。
以两个特征物,特征物A和特征物B为例,标定装置采用迭代优化算法,对待优化的外参值进行迭代优化的过程中,在参考坐标系O-xyz下,统计特征物A的特征点云集合在x轴上的方差1、在y轴上的方差2、在z轴上的方差3,根据统计得到的方差1、方差2和方差3,得到特征物A的特征点云集合在参考坐标系的各轴向上的方差之和,即得到特征物A的误差参数,标定装置在参考坐标系O-xyz下,统计特征物B的特征点云集合在x轴上的方差4、在y轴上的方差5、在z轴上的方差6,根据统计得到的方差4、方差5和方差6,得到特征物B的特征点云集合在参考坐标系的各轴向上的方差之和,即得到特征物B的误差参数。当特征物A的误差参数小于第二门限,且特征物B的误差参数小于第二门限时,停止迭代,输出调整后的外参值。
作为另一种举例,第一迭代停止条件也可以为当前次迭代中X个特征物的误差参数之和与上一次迭代中X个特征物的误差参数之和的差值小于第一门限。
仍以特征物A和特征物B为例,标定装置采用迭代优化算法,对待优化的外参值进行迭代优化的过程中,在参考坐标系O-xyz下,统计特征物A的特征点云集合在x轴上的方差1、在y轴上的方差2、在z轴上的方差3,得到特征物A的特征点云集合在参考坐标系的各轴向上的方差之和,即得到特征物A的误差参数,在参考坐标系O-xyz下,统计特征物B的特征点云集合在x轴上的方差4、在y轴上的方差5、在z轴上的方差6,得到特征物B的特征点云集合在参考坐标系的各轴向上的方差之和,即得到特征物B的误差参数,然后,标定装置将特征物A的误差参数和特征物B的误差参数进行加和,得到特征物A和特征物B的误差参数之和。当特征物A和特征物B的误差参数之和小于第一门限时,停止迭代,输出调整后的外参值。
采用迭代优化算法,对待优化的外参值进行迭代优化过程中,若不满足第一迭代停止条件,则根据设定步长,对待优化的外参值进行调整。设定步长包括偏移距离的步长和偏移角度的步长,比如,偏移距离的步长可以为0.1cm,再比如,偏移角度的步长可以为0.01°。
作为第二种可能的实现方式,标定装置确定满足第一迭代停止条件和第二迭代停止条件时,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在参考坐标系中的位置相同或者位置相差满足预设条件。
第二迭代停止条件也可以采用但不限于固定迭代次数法、固定时间法、前后作差法中的任一项。
以第二迭代停止条件采用前后作差法为例,第二迭代停止条件可以是当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限。
示例性的,第三门限包括距离门限和角度门限,标定装置判断当前次调整使用的外参值与上一次调整使用的待优化的外参值之间的偏移距离的差值是否小于距离门限,以及判断当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的偏移角度的差值是否小于角度门限。
若当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的偏移距离的差值小于距离门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的偏移角度小于角度门限,则将当前次调整使用的待优化的外参值作为目标外参值。
进一步的,为消除采集车辆运动带来的点云重影误差,标定装置在对第三点云数据进行特征物提取之前,还可以根据IMU采集的采集车辆的位置、姿态和速度,对第一点云数据、第二点云数据或第三点云数据进行运动补偿。运动补偿是一种描述相邻帧差别的方法,用于消除采集车辆的速度、线加速度或角速度中的任一项带来的运动影响。
实施例一:以参考坐标系为公共坐标系为例。
图6为本申请实施例中提供的一种可能的激光雷达与IMU的外参标定方法,该方法可由标定装置执行,也可以由标定装置中的芯片或芯片系统执行。
S601、标定装置获取IMU采集的测量数据,并根据IMU采集的测量数据,得到IMU在公共坐标系的位姿信息集合,位姿信息包括三维位置、三维速度、三维姿态角中的一项或多项,下文中将三维位置、三维速度、三维姿态角简称为位置、速度、姿态角。IMU在公共坐标系的位姿信息用于描述IMU坐标系与公共坐标系之间的相对转换关系。
位姿信息集合中包括IMU在M个采集时刻采集的位姿信息。
IMU采集的测量信息包括线加速度和角速度。在采集车辆行驶在采集路线的过程中,IMU可以采集到采集车辆在N个采集时刻的线加速度和角速度。进一步的,IMU采集到测量信息后可以将测量信息存储到存储区域,例如,存储区域可以是采集车辆中配置的硬盘、便携笔记本等。在进行激光雷达与IMU的外参标定时,标定装置可以从存储区域中,获取到存储的IMU采集的测量信息。
示例性的,采集车辆中可以配置有惯性导航系统(inertial navigation system,INS),INS中包含IMU。标定装置获取到IMU的测量信息后,通过惯性导航系统(inertialnavigation system,INS),对IMU采集的测量信息进行惯性导航计算,得到INS导航信息,该INS导航信息包括采集车辆在IMU坐标系下的三维位置、三维速度、三维姿态角中的一项或多项。采集车辆中还配置有GNSS,在采集车辆行驶在采集路线的过程中,GNSS可以采集到GNSS测量信息,GNSS测量信息包括采集车辆在公共坐标系下的三维位置、三维速度、三维姿态角中的一项或多项。标定装置采用惯性导航算法和融合滤波算法,对INS导航信息和GNSS测量信息进行融合,可以得到IMU在公共坐标系的位姿信息集合。
S602、标定装置获取激光雷达采集的点云数据。激光雷达采集的点云数据中包括激光雷达在N个采集时刻采集到的N帧点云数据。
S603、标定装置根据第M组外参值,将点云数据从雷达坐标系转换到IMU坐标系,得到IMU坐标系下的点云数据。M为自然数。
当M的取值为0时,第0组外参值也可称为初始外参值,初始外参值包括雷达坐标系和IMU坐标系之间的偏移距离和偏移角度。
S604、标定装置根据点云数据的采集时刻对应的位姿信息,将IMU坐标系下的点云数据,投影到公共坐标系,得到公共坐标系下的点云数据。
以单帧点云数据为例,单帧点云数据为IMU坐标系下的点云数据中的任意一帧点云数据。
作为一种可能的情况,单帧点云数据的采集时刻和位姿信息集合中的一个位姿信息的采集时刻相同。标定装置可以确定单帧点云数据的采集时刻对应的位姿信息为上述一个位姿信息。
作为另一种可能的情况,单帧点云数据的采集时刻和位姿信息集合中的位姿信息的采集时刻不相同。标定装置可以采用插值算法,计算出采集时刻为单帧点云数据的采集时刻时对应的位姿信息,作为目标位姿信息,目标位姿信息用于表示单帧点云数据的采集时刻对应的位姿信息。进一步的,标定装置根据目标位姿信息,将IMU坐标系下的单帧点云数据投影到公共坐标系下。比如,单帧点云数据的GNSS时间为第15秒,位姿信息1的GNSS时间为第14秒,位姿信息2的GNSS时间为第16秒,采用线性插值算法,计算得到第15秒的位姿信息为位姿信息1和位姿信息2的平均值,作为目标位姿信息。
进一步的,为消除采集车辆运动带来的点云重影误差,标定装置在将IMU坐标系下的点云数据,投影到公共坐标系后,根据位姿信息和/或IMU的测量数据,对公共坐标系下的点云数据进行运动补偿。
S605、标定装置对公共坐标系下的点云数据进行特征物提取,得到各个特征物的特征点云集合。
S606、标定装置采用迭代优化算法,对第M组外参值进行迭代优化,直至满足第一迭代停止条件,得到第M+1组外参值,具体参见S504。
标定装置采用迭代优化算法时,将误差参数作为目标函数,将第M组外参值作为优化变量。标定装置可以根据各个特征物的特征点云集合,计算得到各个特征物的误差参数。以第一迭代停止条件采用前后作差法为例,第一迭代停止条件可以为当前次迭代中各个特征物的误差参数与上一次迭代中各个特征物的误差参数的差值均小于第一误差门限。
S607、标定装置判断是否满足第二迭代停止条件,若是,执行S609,否则,执行S608。
以第二迭代停止条件采用前后作差法为例,标定装置判断第M+1组外参值与第M组外参值之间的偏移距离的差值是否小于距离门限,以及判断第M+1组外参值与第M组外参值之间的偏移角度的差值是否小于角度门限。
当第M+1组外参值与第M组外参值之间的偏移距离的差值小于距离门限,且第M+1组外参值与第M组外参值之间的相对偏角的偏移角度小于角度门限时,执行S609,即将第M+1组外参值作为目标外参值,否则执行S608。
S608、标定装置采用第M+1组外参值替换第M组外参值,执行S603。
S609、标定装置将第M组外参值作为目标外参值。
实施例二:以参考坐标系为局部坐标系为例。图7为本申请实施例中提供的一种可能的激光雷达与IMU的外参标定方法,该方法可由标定装置执行,也可以由标定装置中的芯片或芯片系统执行。下文中,以S701-S709的执行主体为标定装置为例。
S701、标定装置获取IMU采集的测量数据,并根据IMU采集的测量数据,得到分别在M个采集时刻的IMU坐标系与局部坐标系的相对转换关系。
作为一种举例,局部坐标系为固定时刻的IMU坐标系,比如,固定时刻的IMU坐标系为0s时刻的IMU坐标系。以固定时刻的IMU坐标系为0s时刻的IMU坐标系为例,IMU采集的测量信息中包含IMU在M个采集时刻采集的采集车辆的线加速度和角速度。标定装置获取IMU采集的测量信息后,根据M个采集时刻采集的线加速度和角速度,通过积分计算,可以得到M个采集时刻的IMU坐标系与0s时刻的IMU坐标系之间的相对转换关系。比如,IMU采集的测量数据中包含IMU在0s时刻采集的线加速度和角速度,以及包含IMU在1s时刻采集的线加速度和角速度,标定装置可以根据0s时刻和1s时刻采集的线加速度和角速度,通过积分计算,得到1s时刻的IMU坐标系与0s时刻的IMU坐标系之间的相对转换关系。
作为另一种举例,局部坐标系为固定时刻的雷达坐标系,比如,固定时刻的IMU坐标系为0s时刻的雷达坐标系。以固定时刻的IMU坐标系为0s时刻的雷达坐标系为例,标定装置获取IMU采集的测量信息后,根据M个采集时刻采集的线加速度和角速度,通过积分计算,可以得到M个采集时刻的IMU坐标系与0s时刻的IMU坐标系之间的相对转换关系。标定装置根据初始外参值,可以得到M个采集时刻的IMU坐标系与0s时刻的雷达坐标系之间的相对转换关系。
S702、标定装置获取激光雷达采集的点云数据,具体参见S501。
S703、标定装置根据第M组外参值,将点云数据从雷达坐标系转换到IMU坐标系,得到IMU坐标系下的点云数据,具体参见S502。
S704、标定装置根据IMU坐标系与局部坐标系的相对转换关系,将IMU坐标系下的点云数据,转换到局部坐标系,得到局部坐标系下的点云数据,具体参见S503。
S705、标定装置对局部坐标系下的点云数据进行特征物提取,得到各个特征物的特征点云集合,具体参见S504。
S706、标定装置采用迭代优化算法,对第M组外参值进行迭代优化,直至满足第一迭代停止条件,得到第M+1组外参值,具体参见S504。
S707、标定装置判断是否满足第二迭代停止条件,若是,执行S709,否则,执行S708。
S708、标定装置采用第M+1组外参值替换第M组外参值,执行S703。
S709、标定装置将第M组外参值作为目标外参值。
通过上述方法,通过待优化的外参值以及IMU与局部坐标系的相对转换关系,将激光雷达采集到的点云数据转换到局部坐标系下,并对局部坐标系下的点云数据进行特征物提取,得到各个特征物的特征点云数据。然后根据各个特征物的特征点云数据对待优化的外参值进行迭代优化,实现激光雷达与IMU坐标系之间的自动化标定,提高激光雷达与IMU坐标系的标定效率,且避免激光雷达的安装角度对标定精度的影响。
基于相同构思,本申请实施例中提供第二种可能的激光雷达与IMU的外参标定方法。本申请实施例中,标定装置获取激光雷达采集的第一点云数据;标定装置在当前次调整中,根据待优化的外参值,以及根据IMU坐标系与参考坐标系的第二相对转换关系,得到激光雷达坐标系与参考坐标系的第四相对转换关系,待优化的外参值用于指示激光雷达坐标系和IMU坐标系之间的第一相对转换关系;其中,IMU坐标系与参考坐标系的第二相对转换关系的确定方式参见实施例一、实施例二所示;标定装置根据激光雷达坐标系与参考坐标系的第四相对转换关系,将第一点云数据从激光雷达坐标系转换到参考坐标系得到第二点云数据;根据第二点云数据对待优化的外参值进行调整;标定装置根据第二点云数据,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
以参考坐标系为局部坐标系为例,图8为本申请实施例中提供的第二种可能的激光雷达与IMU的外参标定方法,该方法可由标定装置执行,也可以由标定装置中的芯片或芯片系统执行。下文中,以S801-S808的执行主体为标定装置为例。
S801、标定装置获取IMU采集的测量数据,并根据IMU采集的测量数据,得到分别在M个采集时刻IMU坐标系与局部坐标系的相对转换关系。其中,M个采集时刻,IMU坐标系与局部坐标系的相对转换关系的确定方式参见S701。
S802、标定装置获取激光雷达采集的点云数据,具体参见S501。
S803、标定装置根据第M组外参值,以及根据分别在M个采集时刻IMU坐标系与局部坐标系的相对转换关系,得到分别在N个采集时刻雷达坐标系与局部坐标系的相对转换关系。
示例性的,根据分别在M个采集时刻,IMU坐标系与局部坐标系的相对转换关系,采用插值算法,获得分别在N个采集时刻,IMU坐标系与局部坐标系的相对转换关系;根据第M组外参值,以及根据分别在N个采集时刻,IMU坐标系与局部坐标系的相对转换关系,可以得到分别在N个采集时刻,雷达坐标系与局部坐标系的相对转换关系。
S804、标定装置根据分别在N个采集时刻,雷达坐标系与局部坐标系的相对转换关系,将雷达坐标系下的点云数据,转换到局部坐标系,得到局部坐标系下的点云数据。
S805、标定装置对局部坐标系下的点云数据进行特征物提取,得到各个特征物的特征点云集合,具体参见S504。
S806、标定装置采用迭代优化算法,对第M组外参值进行调整,直至满足第一迭代停止条件,得到第M+1组外参值,具体参见S504。
S807、标定装置判断是否满足第二迭代收敛条件,若是,执行S809,否则,执行S808。
S808、标定装置采用第M+1组外参值替换第M组外参值,执行S803。
S809、标定装置将第M+1组外参值作为目标外参值。
基于相同构思,本申请实施例中提供第三种可能的激光雷达与IMU的外参标定方法。本申请实施例中,标定装置获取激光雷达采集的第一点云数据,第一点云数据用于表征待标定车辆行驶在目标路径上采集的待标定车辆周围的特征物在激光雷达坐标系中的位置;在当前次调整中,标定装置根据待优化的外参值,将第一点云数据从激光雷达坐标系转换为IMU坐标系得到第二点云数据,待优化的外参值用于指示激光雷达坐标系和IMU坐标系之间的第一相对转换关系;标定装置根据第二点云数据,确定当前次调整使用的待优化的外参值使得激光雷达行驶到不同的位置采集的同一特征物在IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
参阅图9所示,图9为本申请实施例中提供的第三种可能的激光雷达与IMU的外参标定方法,该方法可由标定装置执行,也可以由标定装置中的芯片或芯片系统执行。
S901、标定装置获取激光雷达采集的点云数据,具体参见S501。
S902、标定装置根据第M组外参值,将点云数据从雷达坐标系转换到IMU坐标系,得到IMU坐标系下的点云数据,具体参见S502。
S903、标定装置对IMU坐标系下的点云数据进行特征物提取,得到各个特征物的特征点云集合。标定装置对IMU坐标系下的点云数据进行特征物提取的过程,与S504中对第三点云数据进行特征物提取的过程类似,在此不再赘述。
S904、标定装置采用迭代优化算法,对第M组外参值进行迭代优化,直至满足第一迭代停止条件,得到第M+1组外参值。
S905、标定装置判断是否满足第二迭代收敛条件,若是,执行S907,否则,执行S906。
S906、标定装置采用第M+1组外参值替换第M组外参值,执行S902。
S907、标定装置将第M组外参值作为目标外参值。
通过上述方法,根据待优化的外参值将激光雷达采集的点云数据从雷达坐标系转换到IMU坐标系后,可以直接根据IMU坐标系下的点云数据对待优化的外参值进行优化,提高外参标定效率,且避免激光雷达的安装角度对标定精度的影响。
基于上述实施例,本申请实施例中还提供的一种多个激光雷达之间的外参标定方法,在进行多个激光雷达之间的外参标定时,可以根据图5-图9中任一种可能的方法,分别得到各个激光雷达与IMU之间的外参值,根据各个激光雷达与IMU之间的外参值,得到多个激光雷达之间的外参值。
以第一激光雷达和第二激光雷达之间的外参标定过程为例,参见S501-S504,可以得到第一激光雷达和IMU之间的第一外参值,以及得到第二激光雷达和IMU之间的第二外参值。根据第一外参值和第二外参值之间的相对关系,得到第一激光雷达和第二激光雷达之间的外参值。
以第一激光雷达、第二激光雷达、第三激光雷达之间的外参标定过程为例,参见S501-S504,可以得到第一激光雷达和IMU之间的第一外参值、第二激光雷达和IMU之间的第二外参值、以及第三激光雷达和IMU之间的第三外参值。根据第一外参值和第二外参值之间的相对关系,可以得到第一激光雷达和第二激光雷达之间的外参值。根据第一外参值和第三外参值之间的相对关系,可以得到第一激光雷达和第三激光雷达之间的外参值。根据第二外参值和第三外参值之间的相对关系,可以得到第二激光雷达和第三激光雷达之间的外参值。
基于相同的技术构思,本申请还提供了一种激光雷达与IMU的外参标定装置,该标定装置的结构如图10所示,包括通信单元1001和处理单元1002。所述标定装置1000可以应用于图5-图9所示的标定方法中的标定装置。下面对标定装置1000中的各个单元的功能进行介绍。
所述通信单元1001,用于接收和发送数据。
所述标定装置1000应用于标定装置时,所述通信单元601又可以称为物理接口、通信模块、通信接口、输入输出接口。
在一种可能的应用场景中,标定装置1000包括通信单元1001和处理单元1002,
通信单元1001,用于获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
处理单元1002,用于在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据;所述第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的待标定车辆的位置和姿态获得的;以及,根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
在一种可能的设计中,所述第一点云数据是所述激光雷达在N个第一采集时刻采集的,所述通信单元1001还用于获取所述IMU在M个第二采集时刻采集的测量数据,所述测量数据包括所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的线加速度和角速度;
获取所述IMU坐标系与所述参考坐标系的第二相对转换关系时,所述处理单元1002用于:根据所述测量数据,得到分别在M个第二采集时刻的第二相对转换关系,所述第二采集时刻的第二相对转换关系用于表征在所述第二采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系。
在一种可能的设计中,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据时,所述处理单元1002用于:
根据分别在M个第二采集时刻的第二相对转换关系,获得分别在所述N个第一采集时刻的第三相对转换关系,所述第一采集时刻的第三相对转换关系用于表征在所述第一采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系;
根据第i个第一采集时刻的第三相对转换关系,分别将第i个第一采集时刻的第二点云数据,转换到所述参考坐标系,得到第i个第一采集时刻的点云数据,i取遍小于或者等于N的正整数,以得到N个第一采集时刻的点云数据构成所述第三点云数据。
在一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据时,所述处理单元1002用于:
根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据从所述IMU坐标系转换为所述参考坐标系,得到第四点云数据;
将运动补偿后的第四点云数据作为所述第三点云数据,所述运动补偿后的第四点云数据是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置、姿态和速度进行的运动补偿。
在另一种可能的应用场景中,标定装置1000包括通信单元1001和处理单元1002,
通信单元1001,用于获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
处理单元1002,用于在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;以及,根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
在一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在一种可能的设计中,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元1002用于:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
在又一种可能的应用场景中,标定装置1000包括通信单元1001和处理单元1002,
通信单元1001,用于获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
处理单元1002,用于在当前次调整中,根据待优化的外参值,以及根据IMU坐标系与参考坐标系的第二相对转换关系,得到激光雷达坐标系与参考坐标系的第四相对转换关系,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系,所述IMU坐标系与参考坐标系的第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置和姿态获得的;根据所述激光雷达坐标系与所述参考坐标系的第四相对转换关系,将所述第一点云数据从所述激光雷达坐标系转换到所述参考坐标系得到第二点云数据;以及,根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
基于相同的技术构思,本申请还提供了一种激光雷达与IMU的外参标定装置,所述标定装置1100可以实现图5-图9所示的标定方法中的标定装置的功能。参阅图11所示,标定装置1100包括:收发器1101、处理器1102以及存储器1103。其中,所述收发器1101、所述处理器1102以及所述存储器1103之间相互连接。示例性的,处理器1102可以用于执行图5-图9所示的任一实施例中由标定装置所执行的除了获取操作之外的全部操作。
示例性的,所述收发器1101、所述处理器1102以及所述存储器1103之间通过总线1104相互连接。所述总线1104可以是外设部件互连标准(peripheral componentinterconnect,PCI)总线或扩展工业标准结构(extended industry standardarchitecture,EISA)总线等。所述总线可以分为地址总线、数据总线、控制总线等。为便于表示,图11中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
所述收发器1101,用于接收和发送数据,实现与其他设备之间的通信交互。
可以理解,本申请图11中的存储器可以是易失性存储器或非易失性存储器,或可包括易失性和非易失性存储器两者。其中,非易失性存储器可以是只读存储器(Read-OnlyMemory,ROM)、可编程只读存储器(Programmable ROM,PROM)、可擦除可编程只读存储器(Erasable PROM,EPROM)、电可擦除可编程只读存储器(Electrically EPROM,EEPROM)或闪存。易失性存储器可以是随机存取存储器(Random Access Memory,RAM),其用作外部高速缓存。通过示例性但不是限制性说明,许多形式的RAM可用,例如静态随机存取存储器(Static RAM,SRAM)、动态随机存取存储器(Dynamic RAM,DRAM)、同步动态随机存取存储器(Synchronous DRAM,SDRAM)、双倍数据速率同步动态随机存取存储器(Double Data RateSDRAM,DDR SDRAM)、增强型同步动态随机存取存储器(Enhanced SDRAM,ESDRAM)、同步连接动态随机存取存储器(Synchlink DRAM,SLDRAM)和直接内存总线随机存取存储器(DirectRambus RAM,DR RAM)。应注意,本文描述的系统和方法的存储器旨在包括但不限于这些和任意其它适合类型的存储器。
基于以上实施例,本申请实施例还提供了一种计算机程序,当所述计算机程序在计算机上运行时,使得所述计算机执行图5-图9所示的实施例提供的标定方法。
基于以上实施例,本申请实施例还提供了一种计算机可读存储介质,该计算机可读存储介质中存储有计算机程序,所述计算机程序被计算机执行时,使得计算机执行图5-图9所示的实施例提供的标定方法。其中,存储介质可以是计算机能够存取的任何可用介质。以此为例但不限于:计算机可读介质可以包括RAM、ROM、EEPROM、CD-ROM或其他光盘存储、磁盘存储介质或者其他磁存储设备、或者能够用于携带或存储具有指令或数据结构形式的期望的程序代码并能够由计算机存取的任何其他介质。
基于以上实施例,本申请实施例还提供了一种芯片,所述芯片用于读取存储器中存储的计算机程序,实现图5-图9所示的实施例提供的标定方法。
基于以上实施例,本申请实施例提供了一种芯片系统,该芯片系统包括处理器,用于支持计算机装置实现图5-图9所示的实施例中标定装置所涉及的功能。在一种可能的设计中,所述芯片系统还包括存储器,所述存储器用于保存该计算机装置必要的程序和数据。该芯片系统,可以由芯片构成,也可以包含芯片和其他分立器件。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
显然,本领域的技术人员可以对本申请进行各种改动和变型而不脱离本申请的保护范围。这样,倘若本申请的这些修改和变型属于本申请权利要求及其等同技术的范围之内,则本申请也意图包含这些改动和变型在内。
Claims (31)
1.一种激光雷达与惯性导航单元IMU的外参标定方法,应用于标定装置,其特征在于,所述激光雷达与所述IMU均固定安装于待标定车辆上,包括:
获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;
根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据;所述第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的待标定车辆的位置和姿态获得的;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
2.如权利要求1所述的方法,其特征在于,所述第一点云数据是所述激光雷达在N个第一采集时刻采集的,获取所述IMU坐标系与所述参考坐标系的第二相对转换关系,包括:
获取所述IMU在M个第二采集时刻采集的测量数据,所述测量数据包括所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的线加速度和角速度;
根据所述测量数据,得到分别在M个第二采集时刻的第二相对转换关系,所述第二采集时刻的第二相对转换关系用于表征在所述第二采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系。
3.如权利要求2所述的方法,其特征在于,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据,包括:
根据分别在M个第二采集时刻的第二相对转换关系,获得分别在所述N个第一采集时刻的第三相对转换关系,所述第一采集时刻的第三相对转换关系用于表征在所述第一采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系;
根据第i个第一采集时刻的第三相对转换关系,分别将第i个第一采集时刻的第二点云数据,转换到所述参考坐标系,得到第i个第一采集时刻的点云数据,i取遍小于或者等于N的正整数,以得到N个第一采集时刻的点云数据构成所述第三点云数据。
4.如权利要求1-3任一项所述的方法,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
5.如权利要求1-3任一项所述的方法,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
6.如权利要求1-3任一项所述的方法,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
7.如权利要求1-3任一项所述的方法,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
8.如权利要求1-7任一项所述的方法,其特征在于,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据,包括:
根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据从所述IMU坐标系转换为所述参考坐标系,得到第四点云数据;
将运动补偿后的第四点云数据作为所述第三点云数据,所述运动补偿后的第四点云数据是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置、姿态和速度进行的运动补偿。
9.一种激光雷达与IMU的外参标定方法,应用于标定装置,其特征在于,所述激光雷达与所述IMU均固定安装于待标定车辆上,包括:
获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
10.如权利要求9所述的方法,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
11.如权利要求9所述的方法,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
12.如权利要求9所述的方法,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
13.如权利要求9所述的方法,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件,包括:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
14.一种激光雷达与IMU的外参标定方法,应用于标定装置,其特征在于,所述激光雷达与所述IMU均固定安装于待标定车辆上,包括:
获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
在当前次调整中,根据待优化的外参值,以及根据IMU坐标系与参考坐标系的第二相对转换关系,得到激光雷达坐标系与参考坐标系的第四相对转换关系,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系,所述IMU坐标系与参考坐标系的第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置和姿态获得的;
根据所述激光雷达坐标系与所述参考坐标系的第四相对转换关系,将所述第一点云数据从所述激光雷达坐标系转换到所述参考坐标系得到第二点云数据;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
15.一种激光雷达与惯性导航单元IMU的外参标定装置,其特征在于,所述激光雷达与所述IMU均固定安装于待标定车辆上,包括:
通信单元,用于获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
处理单元,用于在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据;所述第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的待标定车辆的位置和姿态获得的;以及,根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
16.如权利要求15所述的装置,其特征在于,所述第一点云数据是所述激光雷达在N个第一采集时刻采集的,所述通信单元还用于获取所述IMU在M个第二采集时刻采集的测量数据,所述测量数据包括所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的线加速度和角速度;
获取所述IMU坐标系与所述参考坐标系的第二相对转换关系时,所述处理单元用于:
根据所述测量数据,得到分别在M个第二采集时刻的第二相对转换关系,所述第二采集时刻的第二相对转换关系用于表征在所述第二采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系。
17.如权利要求16所述的装置,其特征在于,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据时,所述处理单元用于:
根据分别在M个第二采集时刻的第二相对转换关系,获得分别在所述N个第一采集时刻的第三相对转换关系,所述第一采集时刻的第三相对转换关系用于表征在所述第一采集时刻,所述IMU坐标系与所述参考坐标系之间的相对转换关系;
根据第i个第一采集时刻的第三相对转换关系,分别将第i个第一采集时刻的第二点云数据,转换到所述参考坐标系,得到第i个第一采集时刻的点云数据,i取遍小于或者等于N的正整数,以得到N个第一采集时刻的点云数据构成所述第三点云数据。
18.如权利要求15-17任一项所述的装置,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
19.如权利要求15-17任一项所述的装置,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
20.如权利要求15-17任一项所述的装置,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
21.如权利要求15-17任一项所述的装置,其特征在于,所述第三点云数据用于表征X个特征物在所述参考坐标系的三维坐标,X为正整数;
根据所述第三点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述参考坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述参考坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
22.如权利要求15-21任一项所述的装置,其特征在于,根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据转换到所述参考坐标系得到第三点云数据时,所述处理单元用于:
根据所述IMU坐标系与所述参考坐标系的第二相对转换关系,将所述第二点云数据从所述IMU坐标系转换为所述参考坐标系,得到第四点云数据;
将运动补偿后的第四点云数据作为所述第三点云数据,所述运动补偿后的第四点云数据是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置、姿态和速度进行的运动补偿。
23.一种激光雷达与IMU的外参标定装置,其特征在于,所述激光雷达与所述IMU均固定安装于待标定车辆上,包括:
通信单元,用于获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
处理单元,用于在当前次调整中,根据待优化的外参值,将所述第一点云数据从所述激光雷达坐标系转换为IMU坐标系得到第二点云数据,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系;以及,根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
24.如权利要求23所述的装置,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
25.如权利要求24所述的装置,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
26.如权利要求24所述的装置,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数之和与上一次调整中X个特征物的误差参数之和的差值小于第一门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
27.如权利要求24所述的装置,其特征在于,所述第二点云数据用于表征X个特征物在所述IMU坐标系的三维坐标,X为正整数;
根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,所述处理单元用于:
若当前次调整中X个特征物的误差参数与上一次调整中X个特征物的误差参数的差值均小于第二门限,且当前次调整使用的待优化的外参值与上一次调整使用的待优化的外参值之间的差值小于第三门限,则确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件;
其中,第一特征物的误差参数为第一特征物在所述IMU坐标系的三个维度的坐标分别对应的方差之和,所述第一特征物为所述X个特征物中的任一个。
28.一种激光雷达与IMU的外参标定装置,其特征在于,所述激光雷达与所述IMU均固定安装于待标定车辆上,包括:
通信单元,用于获取激光雷达采集的第一点云数据,所述第一点云数据用于表征所述待标定车辆行驶在目标路径上采集的所述待标定车辆周围的特征物在激光雷达坐标系中的位置;
处理单元,用于在当前次调整中,根据待优化的外参值,以及根据IMU坐标系与参考坐标系的第二相对转换关系,得到激光雷达坐标系与参考坐标系的第四相对转换关系,所述待优化的外参值用于指示所述激光雷达坐标系和所述IMU坐标系之间的第一相对转换关系,所述IMU坐标系与参考坐标系的第二相对转换关系是根据所述待标定车辆行驶在所述目标路径的过程中所述IMU采集的所述待标定车辆的位置和姿态获得的;根据所述激光雷达坐标系与所述参考坐标系的第四相对转换关系,将所述第一点云数据从所述激光雷达坐标系转换到所述参考坐标系得到第二点云数据;以及,根据所述第二点云数据,确定当前次调整使用的待优化的外参值使得所述激光雷达行驶到不同的位置采集的同一特征物在所述IMU坐标系中的位置相同或者位置相差满足预设条件时,将当前次的待优化的外参值作为目标外参值,否则,对所述待优化的外参值进行调整,并将调整后的外参值作为下一次调整中的待优化的外参值。
29.一种标定装置,其特征在于,包括存储器和一个或多个处理器;其中,所述存储器用于存储计算机程序代码,所述计算机程序代码包括计算机指令;当所述计算机指令被所述处理器执行时,使得所述标定装置执行如权利要求1-8中任一项所述的方法,或执行如权利要求9-13中任一项所述的方法,或执行如权利要求14所述的方法。
30.一种计算机可读存储介质,其特征在于,包括计算机指令,当所述计算机指令在标定装置运行时,使得所述标定装置执行如权利要求1-8中任一项所述的方法,或执行如权利要求9-13中任一项所述的方法,或执行如权利要求14所述的方法。
31.一种计算机程序产品,其特征在于,当所述计算机程序产品在处理器上运行时,使得处理器执行如权利要求1-8中任一项所述的方法,或执行如权利要求9-13中任一项所述的方法,或执行如权利要求14所述的方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011492455.1A CN114636993A (zh) | 2020-12-16 | 2020-12-16 | 一种激光雷达与imu的外参标定方法、装置及设备 |
PCT/CN2021/132432 WO2022127532A1 (zh) | 2020-12-16 | 2021-11-23 | 一种激光雷达与imu的外参标定方法、装置及设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011492455.1A CN114636993A (zh) | 2020-12-16 | 2020-12-16 | 一种激光雷达与imu的外参标定方法、装置及设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114636993A true CN114636993A (zh) | 2022-06-17 |
Family
ID=81944508
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011492455.1A Pending CN114636993A (zh) | 2020-12-16 | 2020-12-16 | 一种激光雷达与imu的外参标定方法、装置及设备 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN114636993A (zh) |
WO (1) | WO2022127532A1 (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114897942A (zh) * | 2022-07-15 | 2022-08-12 | 深圳元戎启行科技有限公司 | 点云地图的生成方法、设备及相关存储介质 |
CN115267751A (zh) * | 2022-08-19 | 2022-11-01 | 广州小鹏自动驾驶科技有限公司 | 传感器标定方法、装置、车辆及存储介质 |
CN116385550A (zh) * | 2022-12-16 | 2023-07-04 | 北京斯年智驾科技有限公司 | 外参标定方法、装置、计算设备、介质和车辆 |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115512242B (zh) * | 2022-07-22 | 2023-05-30 | 北京微视威信息科技有限公司 | 场景变化检测方法及飞行装置 |
CN115236644A (zh) * | 2022-07-26 | 2022-10-25 | 广州文远知行科技有限公司 | 一种激光雷达外参标定方法、装置、设备和存储介质 |
CN115435773B (zh) * | 2022-09-05 | 2024-04-05 | 北京远见知行科技有限公司 | 室内停车场高精度地图采集装置 |
CN116740197B (zh) * | 2023-08-11 | 2023-11-21 | 之江实验室 | 一种外参的标定方法、装置、存储介质及电子设备 |
CN116819469B (zh) * | 2023-08-28 | 2023-11-10 | 南京慧尔视智能科技有限公司 | 一种多雷达目标位置同步方法、装置、设备及存储介质 |
CN117269939B (zh) * | 2023-10-25 | 2024-03-26 | 北京路凯智行科技有限公司 | 用于传感器的参数标定系统、方法及存储介质 |
CN117554937B (zh) * | 2024-01-08 | 2024-04-26 | 安徽中科星驰自动驾驶技术有限公司 | 一种误差可控的激光雷达和组合惯导外参标定方法和系统 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3104189B1 (en) * | 2015-06-11 | 2020-09-30 | Veoneer Sweden AB | Misalignment estimation for a vehicle radar system |
US10481267B2 (en) * | 2017-06-13 | 2019-11-19 | TuSimple | Undistorted raw LiDAR scans and static point extractions method for ground truth static scene sparse flow generation |
US11428817B2 (en) * | 2018-10-11 | 2022-08-30 | Baidu Usa Llc | Automatic LIDAR calibration based on cross validation for autonomous driving |
CN111208492B (zh) * | 2018-11-21 | 2022-04-19 | 长沙智能驾驶研究院有限公司 | 车载激光雷达外参标定方法及装置、计算机设备及存储介质 |
CN111650598A (zh) * | 2019-02-19 | 2020-09-11 | 北京京东尚科信息技术有限公司 | 一种车载激光扫描系统外参标定方法和装置 |
CN110837080B (zh) * | 2019-10-28 | 2023-09-05 | 武汉海云空间信息技术有限公司 | 激光雷达移动测量系统的快速标定方法 |
-
2020
- 2020-12-16 CN CN202011492455.1A patent/CN114636993A/zh active Pending
-
2021
- 2021-11-23 WO PCT/CN2021/132432 patent/WO2022127532A1/zh active Application Filing
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114897942A (zh) * | 2022-07-15 | 2022-08-12 | 深圳元戎启行科技有限公司 | 点云地图的生成方法、设备及相关存储介质 |
CN114897942B (zh) * | 2022-07-15 | 2022-10-28 | 深圳元戎启行科技有限公司 | 点云地图的生成方法、设备及相关存储介质 |
CN115267751A (zh) * | 2022-08-19 | 2022-11-01 | 广州小鹏自动驾驶科技有限公司 | 传感器标定方法、装置、车辆及存储介质 |
CN116385550A (zh) * | 2022-12-16 | 2023-07-04 | 北京斯年智驾科技有限公司 | 外参标定方法、装置、计算设备、介质和车辆 |
Also Published As
Publication number | Publication date |
---|---|
WO2022127532A1 (zh) | 2022-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114636993A (zh) | 一种激光雷达与imu的外参标定方法、装置及设备 | |
JP7398506B2 (ja) | ローカライゼーション基準データを生成及び使用する方法及びシステム | |
CN109696663B (zh) | 一种车载三维激光雷达标定方法和系统 | |
CN113424232B (zh) | 三维点云地图构建方法、系统和设备 | |
CN107328411B (zh) | 车载定位系统和自动驾驶车辆 | |
EP3904908A1 (en) | Method and system for map improvement using feedback from positioning based on radar and motion sensors | |
EP2990828B1 (en) | Point cloud position data processing device, point cloud position data processing system, point cloud position data processing method, and program therefor | |
US10240934B2 (en) | Method and system for determining a position relative to a digital map | |
WO2020107038A1 (en) | Method and system for positioning using radar and motion sensors | |
CN107328410A (zh) | 用于定位自动驾驶车辆的方法和汽车电脑 | |
JP6656886B2 (ja) | 情報処理装置、制御方法、プログラム及び記憶媒体 | |
CN107356244B (zh) | 一种路侧单元天线的标定方法及装置 | |
CN114111775B (zh) | 一种多传感器融合定位方法、装置、存储介质及电子设备 | |
CN113933818A (zh) | 激光雷达外参的标定的方法、设备、存储介质及程序产品 | |
CN113870379A (zh) | 地图生成方法、装置、电子设备及计算机可读存储介质 | |
CN113580134B (zh) | 视觉定位方法、设备、机器人、存储介质及程序产品 | |
CN114323050A (zh) | 车辆定位方法、装置和电子设备 | |
CN112455502B (zh) | 基于激光雷达的列车定位方法及装置 | |
CN116399324A (zh) | 建图方法、装置及控制器、无人驾驶车辆 | |
CN116242373A (zh) | 一种融合多源数据的高精度导航定位方法及系统 | |
CN115900732A (zh) | 基于路侧相机和车载单元的组合导航方法及系统 | |
CN116147605A (zh) | 一种车辆自动驾驶地图生成方法、装置、设备及存储介质 | |
CN115236714A (zh) | 多源数据融合定位方法、装置、设备及计算机存储介质 | |
CN111552757B (zh) | 生成电子地图的方法、装置、设备及存储介质 | |
CN117999207A (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 |