一种基于扇面深度相机的定位系统及定位方法

摘要

本发明公开一种基于扇面深度相机的定位系统，定位系统包括：扇面深度相机，用于采集水平方向上预设角度的扇面范围内的三维点云数据并传输至定位优化模块；图像采集装置，用于采集图像数据并传输至定位优化模块；惯性传感器，用于采集IMU数据并传输至定位优化模块；定位优化模块，用于接收扇面深度相机传输的三维点云数据、图像采集装置传输的图像数据以及惯性传感器传输的IMU数据，并基于图像数据和IMU数据对三维点云数据进行优化，获取优化后的位置信息。本发明采用扇面深度相机实现激光导航定位，同时结合视觉图像数据和IMU数据对扇面深度相机数据进行补偿优化，提高基于扇面深度相机的定位系统的定位精度和可靠性。