组合导航设备与激光雷达的外参标定方法及装置制造方法及图纸

技术编号:33047613 阅读:15 留言:0更新日期:2022-04-15 09:31
本发明专利技术提供一种组合导航设备与激光雷达的外参标定方法及装置,本发明专利技术提供的组合导航设备与激光雷达的外参标定方法及装置,通过获取较为理想的外参初值,可以有效提高最优外参标定解的求取效率和结果精度,通过位姿插值的方式估计激光雷达的位姿信息,相比于通过跑SLAM算法进行雷达位姿估计的方式更加便捷、高效,进而降低了整个外参标定过程的耗时,使得外参标定过程更加高效,外参标定结果更加准确。确。确。

【技术实现步骤摘要】
组合导航设备与激光雷达的外参标定方法及装置


[0001]本专利技术涉及智能驾驶
,尤其涉及一种组合导航设备与激光雷达的外参标定方法及装置。

技术介绍

[0002]高精度的组合导航设备和激光雷达是作业机械高精度定位与感知技术中常用的传感器,在实际应用过程中需要获得组合导航设备与激光雷达的位姿转换关系,但仅根据这两种传感器在作业机械上的安装位置,采用外参测量手段是很难获得外参标定参数的。
[0003]目前,组合导航设备与激光雷达的外参标定,主要通过将激光雷达采集的数据转换到组合导航设备的坐标系下实现。一方面,可以利用外界传感器直接进行外参测量,但由于组合导航设备与激光雷达的安装位置不同,直接测量过程操作复杂,且测量误差较大。
[0004]另一方面,还可以利用激光雷达跑SLAM算法的方式获得激光雷达的里程信息,再结合组合导航设备自身计算的里程信息,进行两坐标系间的变换矩阵计算,即可得到两传感器间的外参标定结果,然而,上述方法需要进行大量的计算,耗时长,且外参标定结果准确度较低。

技术实现思路

[0005]本专利技术提供一种组合导航设备与激光雷达的外参标定方法及装置,用以解决现有技术中组合导航设备与激光雷达的外参标定方法操作繁琐、耗时长且结果准确度低的缺陷,实现高效、准确的组合导航设备与激光雷达的外参标定。
[0006]第一方面,本专利技术提供一种组合导航设备与激光雷达的外参标定方法,该方法包括:
[0007]分别获取组合导航设备采集的原始位姿数据以及激光雷达采集的原始点云数据;
[0008]将所述原始点云数据与所述原始位姿数据进行时间同步,得到时间同步后的时间戳信息;
[0009]根据所述时间同步后的时间戳信息以及所述原始点云数据,对所述原始位姿数据进行位姿插值,得到位姿插值结果;
[0010]根据所述原始位姿数据、所述原始点云数据以及所述位姿插值结果,计算得到外参初值;
[0011]基于所述外参初值以及预先构建的优化目标函数,求解得到最优外参标定解。
[0012]根据本专利技术提供的一种组合导航设备与激光雷达的外参标定方法,根据所述时间同步后的时间戳信息以及所述原始点云数据,对所述原始位姿数据进行位姿插值,得到位姿插值结果,包括:
[0013]分别获取所述原始位姿数据中每个位姿点当前时刻到初始时刻的位姿变换矩阵以及相应的时间戳信息,并获取所述每个雷达点在组合导航设备相应时刻坐标系下对应的虚拟点;
[0014]根据所述时间同步后的时间戳信息,从所述原始位姿数据中获取与所述原始点云数据中每个雷达点对应的时间戳相邻的相邻位姿点;
[0015]基于所述相邻位姿点的时间戳信息以及所述相应的位姿变换矩阵,计算所述虚拟点到组合导航设备初始时刻点的位姿变换矩阵,作为位姿插值结果。
[0016]根据本专利技术提供的一种组合导航设备与激光雷达的外参标定方法,根据所述原始位姿数据、所述原始点云数据以及所述位姿插值结果,计算得到外参初值,包括:
[0017]从所述原始位姿数据中选取多个位姿点,并从所述原始点云数据中选取与每个所述位姿点对应的雷达点;
[0018]分别将各个位姿点与相应的雷达点代入预先构建的变换点坐标表达式,获得多个以待求外参矩阵为未知量的待求解方程,将多个所述待求解方程联立,计算得到外参初值。
[0019]根据本专利技术提供的一种组合导航设备与激光雷达的外参标定方法,所述变换点坐标表达式用于描述变换点坐标是通过所述虚拟点到组合导航设备初始时刻点的位姿变换矩阵、预先构建的待求外参矩阵以及雷达点坐标计算得到的。
[0020]根据本专利技术提供的一种组合导航设备与激光雷达的外参标定方法,基于所述外参初值以及预先构建的优化目标函数,求解得到最优外参标定解,包括:
[0021]基于所述外参初值,以所述原始点云数据中最近距离点的距离之和最小为优化目标构建优化目标函数,求解得到最优外参标定解。
[0022]根据本专利技术提供的一种组合导航设备与激光雷达的外参标定方法,基于所述外参初值,以所述原始点云数据中最近距离点的距离之和最小为优化目标构建优化目标函数,求解得到最优外参标定解,包括:
[0023]基于所述外参初值,对待求外参矩阵进行赋值;
[0024]根据赋值后的待求外参矩阵和所述变换点坐标表达式,获取所述原始点云数据中每个雷达点在组合导航设备初始时刻坐标系下对应的变换点,得到变换点集合;
[0025]分别在所述变换点集合中获取每个变换点对应的至少两个距离最近的邻近变换点,并计算每个变换点与其对应的至少两个邻近变换点的距离;
[0026]将各个所述变换点与其对应的至少两个邻近变换点的距离求和,得到最近距离点的距离之和;
[0027]以所述最近距离点的距离之和最小为优化目标,构建优化目标函数,通过连续赋值迭代寻优;
[0028]直至所述最近距离点的距离之和小于预设距离阈值或赋值迭代次数达到预设次数阈值,将当前赋值后的待求外参矩阵作为最优外参标定解。
[0029]根据本专利技术提供的一种组合导航设备与激光雷达的外参标定方法,基于所述外参初值,以所述原始点云数据中最近距离点的距离之和最小为优化目标构建优化目标函数,求解得到最优外参标定解,包括:
[0030]基于所述外参初值,对待求外参矩阵进行赋值;
[0031]根据赋值后的待求外参矩阵和所述变换点坐标表达式,获取所述原始点云数据中当前扫描帧内每个雷达点在组合导航设备初始时刻坐标系下对应的变换点,作为第一变换点;
[0032]确定当前扫描帧内每个雷达点在下一扫描帧内距离最近的雷达点,并获取所述距
离最近的雷达点在组合导航设备初始时刻坐标系下对应的变换点,作为第二变换点;
[0033]将所述第一变换点和所述第二变换点作为最近距离点对,并将所述原始点云数据中所有最近距离点对组合为最近距离点对集合;
[0034]计算所述最近距离点对集合中所有最近距离点对的距离之和,得到最近距离点的距离之和;
[0035]以所述最近距离点的距离之和最小为优化目标,构建优化目标函数,通过连续赋值迭代寻优;
[0036]直至所述最近距离点的距离之和小于预设距离阈值或赋值迭代次数达到预设次数阈值,将当前赋值后的待求外参矩阵作为最优外参标定解。
[0037]第二方面,一种组合导航设备与激光雷达的外参标定装置,该装置包括:
[0038]获取模块,用于分别获取组合导航设备采集的原始位姿数据以及激光雷达采集的原始点云数据;
[0039]第一处理模块,用于将所述原始点云数据与所述原始位姿数据进行时间同步,得到时间同步后的时间戳信息;
[0040]第二处理模块,用于根据所述时间同步后的时间戳信息以及原始点云数据,对所述原始位姿数据进行位姿插值,得到位姿插值结果;
[0041]第三处理模块,用于根据所述原始位姿数据、所述原始点云数据以及所述位姿插值结果,计算得到外参初值;
...

【技术保护点】

【技术特征摘要】
1.一种组合导航设备与激光雷达的外参标定方法,其特征在于,包括:分别获取组合导航设备采集的原始位姿数据以及激光雷达采集的原始点云数据;将所述原始点云数据与所述原始位姿数据进行时间同步,得到时间同步后的时间戳信息;根据所述时间同步后的时间戳信息以及所述原始点云数据,对所述原始位姿数据进行位姿插值,得到位姿插值结果;根据所述原始位姿数据、所述原始点云数据以及所述位姿插值结果,计算得到外参初值;基于所述外参初值以及预先构建的优化目标函数,求解得到最优外参标定解。2.根据权利要求1所述的一种组合导航设备与激光雷达的外参标定方法,其特征在于,根据所述时间同步后的时间戳信息以及所述原始点云数据,对所述原始位姿数据进行位姿插值,得到位姿插值结果,包括:分别获取所述原始位姿数据中每个位姿点当前时刻到初始时刻的位姿变换矩阵以及相应的时间戳信息,并获取所述每个雷达点在组合导航设备相应时刻坐标系下对应的虚拟点;根据所述时间同步后的时间戳信息,从所述原始位姿数据中获取与所述原始点云数据中每个雷达点对应的时间戳相邻的相邻位姿点;基于所述相邻位姿点的时间戳信息以及所述相应的位姿变换矩阵,计算所述虚拟点到组合导航设备初始时刻点的位姿变换矩阵,作为位姿插值结果。3.根据权利要求1所述的一种组合导航设备与激光雷达的外参标定方法,其特征在于,根据所述原始位姿数据、所述原始点云数据以及所述位姿插值结果,计算得到外参初值,包括:从所述原始位姿数据中选取多个位姿点,并从所述原始点云数据中选取与每个所述位姿点对应的雷达点;分别将各个位姿点与相应的雷达点代入预先构建的变换点坐标表达式,获得多个以待求外参矩阵为未知量的待求解方程,将多个所述待求解方程联立,计算得到外参初值。4.根据权利要求3所述的一种组合导航设备与激光雷达的外参标定方法,其特征在于,所述变换点坐标表达式用于描述变换点坐标是通过所述虚拟点到组合导航设备初始时刻点的位姿变换矩阵、预先构建的待求外参矩阵以及雷达点坐标计算得到的。5.根据权利要求3所述的一种组合导航设备与激光雷达的外参标定方法,其特征在于,基于所述外参初值以及预先构建的优化目标函数,求解得到最优外参标定解,包括:基于所述外参初值,以所述原始点云数据中最近距离点的距离之和最小为优化目标构建优化目标函数,求解得到最优外参标定解。6.根据权利要求5所述的一种组合导航设备与激光雷达的外参标定方法,其特征在于,基于所述外参初值,以所述原始点云数据中最近距离点的距离之和最小为优化目标构建优化目标函数,求解得到最优外参标定解,包括:基于所述外参初值,对待求外参矩阵进行赋值;根据赋值后的待求外参矩阵和所述变换点坐标表达式,获取所述原始点云数据中每个雷达点在组合导航设备初始时刻坐标系下对应的变换点,得到变换点集合;
分别在所述变换点集合中获取每个变换点对应的至少两个距离最近的邻近变换点,并计算每个变换点与其对应的至少两个邻近变换点的距...

【专利技术属性】
技术研发人员:张敏
申请(专利权)人:上海三一重机股份有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1