单目视觉和惯性传感器融合的远距离测距系统及方法

摘要

本公开提供一种单目视觉和惯性传感器融合的远距离测距系统及方法，所述系统包括：单目视觉SLAM模块，包括单目相机，用于采集视觉图像数据；IMU模块，用于获得IMU模块的IMU位姿数据；以及尺度估计模块，将所述视觉图像数据和IMU位姿数据进行融合，实现尺度估计和定位建图，获得具备真实尺度的地图信息，完成待测目标的距离测距。所述测距方法包括：步骤S1：通过单目相机采集视觉图像数据，并进行视觉定位和重投影构建地图；步骤S2：在步骤S1所构建的地图中标注出待测距的目标物体；步骤S3：对所构建的地图构建的地图进行尺度估计；以及步骤S4：根据尺度估计结果，对构建的地图进行尺度缩放，从而获得具备真实尺度的地图信息，获得待测目标距离数据。