Yang Jung-Cheng, Lin Chun-Jung, You Bing-Yuan, Yan Yin-Long, Cheng Teng-Hu
Department of Mechanical Engineering, National Yang Ming Chiao Tung University, Hsinchu 30010, Taiwan.
Sensors (Basel). 2021 Jun 8;21(12):3955. doi: 10.3390/s21123955.
Most UAVs rely on GPS for localization in an outdoor environment. However, in GPS-denied environment, other sources of localization are required for UAVs to conduct feedback control and navigation. LiDAR has been used for indoor localization, but the sampling rate is usually too low for feedback control of UAVs. To compensate this drawback, IMU sensors are usually fused to generate high-frequency odometry, with only few extra computation resources. To achieve this goal, a real-time LiDAR inertial odometer system (RTLIO) is developed in this work to generate high-precision and high-frequency odometry for the feedback control of UAVs in an indoor environment, and this is achieved by solving cost functions that consist of the LiDAR and IMU residuals. Compared to the traditional LIO approach, the initialization process of the developed RTLIO can be achieved, even when the device is stationary. To further reduce the accumulated pose errors, loop closure and pose-graph optimization are also developed in RTLIO. To demonstrate the efficacy of the developed RTLIO, experiments with long-range trajectory are conducted, and the results indicate that the RTLIO can outperform LIO with a smaller drift. Experiments with odometry benchmark dataset (i.e., KITTI) are also conducted to compare the performance with other methods, and the results show that the RTLIO can outperform ALOAM and LOAM in terms of exhibiting a smaller time delay and greater position accuracy.
大多数无人机在室外环境中依靠全球定位系统(GPS)进行定位。然而,在GPS信号被阻断的环境中,无人机进行反馈控制和导航需要其他定位源。激光雷达已被用于室内定位,但采样率通常过低,无法用于无人机的反馈控制。为了弥补这一缺点,通常会将惯性测量单元(IMU)传感器融合起来以生成高频里程计,且只需很少的额外计算资源。为实现这一目标,本文开发了一种实时激光雷达惯性里程计系统(RTLIO),用于在室内环境中为无人机的反馈控制生成高精度和高频里程计,这是通过求解由激光雷达和IMU残差组成的代价函数来实现的。与传统的激光雷达惯性里程计(LIO)方法相比,即使设备静止,所开发的RTLIO也能完成初始化过程。为了进一步减少累积的位姿误差,RTLIO还开发了回环检测和位姿图优化功能。为了验证所开发的RTLIO的有效性,进行了长距离轨迹实验,结果表明RTLIO的漂移更小,性能优于LIO。还使用里程计基准数据集(即KITTI)进行实验,以与其他方法比较性能,结果表明RTLIO在表现出更小的时间延迟和更高的位置精度方面优于ALOAM和LOAM。