[发明专利]运动物体及其传感器的标定方法、装置、存储介质

说明书

本公开涉及一种运动物体及其传感器的标定方法、装置、存储介质，用于提高传感器数据融合结果的准确性和可靠性。该方法包括：获取每个传感器在运动物体的运动过程中各自产生的测量数据；根据每一传感器的测量数据，确定每一传感器的角速度序列；根据每一传感器的角速度序列，确定各传感器在同一时刻的目标角速度序列；确定各传感器的目标角速度序列之间的映射矩阵，并将映射矩阵作为各传感器之间的旋转标定矩阵，该旋转标定矩阵用于对各所述传感器的测量数据进行数据融合。

技术领域

本公开涉及环境感知技术领域，具体地，涉及一种运动物体及其传感器的标定方法、装置、存储介质。

背景技术

深度相机、激光雷达、惯性测量单元(Inertial Measurement Unit，简称“IMU”)的融合被广泛的应用到无人驾驶领域和机器人领域中，在环境感知方面，可以达到比单传感器得到的环境信息更加精确、数据鲁棒性更高的技术效果。

具体来说，单个传感器存在局限性，比如多线激光雷达可以测量出真实环境的外表特征，但是在外表特征不明显的情况下(如空旷环境、长走廊)无法很好工作；惯性测量单元IMU可以高频快速的测量自身运动，但是随时间增长误差会迅速累积。激光雷达与惯性测量单元IMU结合使用可以很好地优势互补：短时间内用惯性测量单元IMU做预测，然后用激光雷达修正累积误差，以实现有效的环境感知。然而，利用现有技术进行数据融合的过程中，多传感器之间参数标定成本高，算法严格复杂，容易导致参数标定存在较大偏差。

发明内容

本公开的目的是提供一种运动物体及其传感器的标定方法、装置、存储介质，用于提高传感器数据融合结果的准确性和可靠性。

为了实现上述目的，本公开第一方面提供一种传感器的标定方法，应用于运动物体，所述运动物体安装有多个传感器，所述传感器的标定方法包括：

获取每个传感器在所述运动物体的运动过程中各自产生的测量数据；

根据每一所述传感器的测量数据，确定每一所述传感器的角速度序列；

根据每一所述传感器的角速度序列，确定各所述传感器在同一时刻的目标角速度序列；

确定各所述传感器的目标角速度序列之间的映射矩阵，并将所述映射矩阵作为各所述传感器之间的旋转标定矩阵，所述旋转标定矩阵用于对各所述传感器的测量数据进行数据融合。

可选地，所述多个传感器包括激光雷达，所述根据每一所述传感器的测量数据，确定每一所述传感器的角速度序列，包括：

根据所述激光雷达的测量数据确定相邻两帧测量数据之间的旋转矩阵；

将所述旋转矩阵转化为欧拉角；

根据所述欧拉角以及所述相邻两帧测量数据之间的时间差计算得到所述角速度序列。

可选地，所述多个传感器包括惯性测量单元，所述根据每一所述传感器的测量数据，确定每一所述传感器的角速度序列，包括：

从所述惯性测量单元的测量数据中，获取所述惯性测量单元的角速度序列。

可选地，所述多个传感器包括第一传感器以及第二传感器，所述根据每一所述传感器的角速度序列，确定各所述传感器在同一时刻的目标角速度序列，包括：

以所述第一传感器的角速度序列为基准，对所述第二传感器的角速度序列进行插值处理，使得插值得到的角速度与所述第一传感器的角速度序列中的任一角速度在时间上对齐，得到时间已对齐的各所述传感器的目标角速度序列。

可选地，所述确定各所述传感器的目标角速度序列之间的映射矩阵，包括：

针对时间已对齐的各所述传感器的目标角速度序列中的每一组目标角速度，建立从所述第一传感器的目标角速度映射到所述第二传感器的目标角速度的方程，得到方程组；