INS/MPS/LiDAR Integrated Navigation System Using Federated Kalman Filter in an Indoor Environment

In this paper, we propose a method to integrate data from Inertial Navigation System (INS), Magnetic Pose Estimation System (MPS), and Laser Imaging Detection and Ranging (LiDAR) using a Federated Kalman Filter (FKF). We adaptively adjusted the information sharing factor using the Mahalanobis distance to maintain navigation performance in indoor environments with mirrors that contaminate LiDAR measurements. By adaptively adjusting the information sharing factor, we can adjust the weight of each local filter. To validate navigation performance, we conducted UGV driving tests in various indoor environments. We conducted experiments by driving a UGV on a course with a diameter of 3.6 meters. UGVs are equipped with LiDAR, MPS receivers, and IMUs to measure data. We used four 1-meter diameter MPS coils. An optical motion capture device, the Optitrack, was used as reference data.