FF-LINS: A Consistent Frame-to-Frame Solid-State-LiDAR-Inertial State Estimator

Most of the existing LiDAR-inertial navigation systems are based on frame-to-map registrations, leading to inconsistency in state estimation. The newest solid-state LiDAR with a non-repetitive scanning pattern makes it possible to achieve a consistent LiDAR-inertial estimator by employing a frame-to-frame data association. In this letter, we propose a robust and consistent frame-to-frame LiDAR-inertial navigation system (FF-LINS) for solid-state LiDARs. With the INS-centric LiDAR frame processing, the keyframe point-cloud map is built using the accumulated point clouds to construct the frame-to-frame data association. The LiDAR frame-to-frame and the inertial measurement unit (IMU) preintegration measurements are tightly integrated using the factor graph optimization, with online calibration of the LiDAR-IMU extrinsic and time-delay parameters. The experiments on the public and private datasets demonstrate that the proposed FF-LINS achieves superior accuracy and robustness than the state-of-the-art systems. Besides, the LiDAR-IMU extrinsic and time-delay parameters are estimated effectively, and the online calibration notably improves the pose accuracy. The proposed FF-LINS and the employed datasets are open-sourced on GitHub (https://github.com/i2Nav-WHU/FF-LINS)

Improvement of GNSS Carrier Phase Accuracy Using MEMS Accelerometer-Aided Phase-Locked Loops for Earthquake Monitoring

When strong earthquake occurs, global navigation satellite systems (GNSS) measurement errors increase significantly. Combined strategies of GNSS/accelerometer data can estimate better precision in displacement, but are of no help to carrier phase measurement. In this paper, strong-motion accelerometer-aided phase-locked loops (PLLs) are proposed to improve carrier phase accuracy during strong earthquakes. To design PLLs for earthquake monitoring, the amplitude-frequency characteristics of the strong earthquake signals are studied. Then, the measurement errors of PLLs before and after micro electro mechanical systems (MEMS) accelerometer aiding are analyzed based on error models. Furthermore, tests based on a hardware simulator and a shake table are carried out. Results show that, with MEMS accelerometer aiding, the carrier phase accuracy of the PLL decreases little under strong earthquakes, which is consistent with the models analysis

Modeling and Quantitative Analysis of GNSS/INS Deep Integration Tracking Loops in High Dynamics

To meet the requirements of global navigation satellite systems (GNSS) precision applications in high dynamics, this paper describes a study on the carrier phase tracking technology of the GNSS/inertial navigation system (INS) deep integration system. The error propagation models of INS-aided carrier tracking loops are modeled in detail in high dynamics. Additionally, quantitative analysis of carrier phase tracking errors caused by INS error sources is carried out under the uniform high dynamic linear acceleration motion of 100 g. Results show that the major INS error sources, affecting the carrier phase tracking accuracy in high dynamics, include initial attitude errors, accelerometer scale factors, gyro noise and gyro g-sensitivity errors. The initial attitude errors are usually combined with the receiver acceleration to impact the tracking loop performance, which can easily cause the failure of carrier phase tracking. The main INS error factors vary with the vehicle motion direction and the relative position of the receiver and the satellites. The analysis results also indicate that the low-cost micro-electro mechanical system (MEMS) inertial measurement units (IMU) has the ability to maintain GNSS carrier phase tracking in high dynamics

Quantitative Analysis to the Impacts of IMU Quality in GPS/INS Deep Integration

In the Global Positioning System (GPS)/Inertial Navigation System (INS) deep integration system, the pure negative effect of the INS aiding is mainly the INS navigation error that is independent with the motion dynamics, which determine whether the INS aiding is worthy. This paper quantitatively assesses the negative effects of the inertial aiding information from different grades of INS by modeling the phase-locked loops (PLLs) based on the scalar-based GPS/INS deep integration system under stationary conditions. Results show that the largest maneuver-independent velocity error caused by the error sources of micro-electro-mechanical System (MEMS) inertial measurement unit (IMU) is less than 0.1 m/s, and less than 0.05 m/s for the case of tactical IMU during the typical GPS update interval (i.e., 1 s). The consequent carrier phase tracking error in the typical tracking loop is below 1.2 degrees for MEMS IMU case and 0.8 degrees for the tactical IMU case, which are much less than the receiver inherent errors. Conclusions can be reached that even the low-end MEMS IMU has the ability of aiding the receiver signal tracking. The tactical grade IMU can provide higher quality aiding information and has potential for the open loop tracking of GPS

Improving the Design of MEMS INS-Aided PLLs for GNSS Carrier Phase Measurement under High Dynamics

The phase locked loop (PLL) bandwidth suffers a dilemma on carrier phase accuracy and dynamic stress tolerance in stand-alone global navigation satellite systems (GNSS) receivers. With inertial navigation system (INS) aiding, PLLs only need to tolerate aiding information error, instead of dynamic stress. To obtain accurate carrier phase under high dynamics, INS-aided PLLs need be optimally designed to reduce the impact of aiding information error. Typical micro-electro-mechanical systems (MEMS) INS-aided PLLs are implemented and tested under high dynamics. Tests using simulation show there is a step change in the aiding information at each integer second, which deteriorates the carrier phase accuracy. An improved structure of INS-aided PLLs is proposed to eliminate the step change impact. Even when the jerk is 2000 m/s3, the tracking error of the proposed INS-aided PLL is no more than 3°. Finally, the performances of stand-alone PLLs and INS-aided PLLs are compared using field tests. When the antenna jerk is 300 m/s3, the carrier phase error from the stand-alone PLLs significantly increased, while the carrier phase error from the MEMS INS-aided PLLs almost remained the same. Therefore, the proposed INS-aided PLLs can suppress tracking errors caused by noise and dynamic stress simultaneously under high dynamics

Modeling and Development of INS-Aided PLLs in a GNSS/INS Deeply-Coupled Hardware Prototype for Dynamic Applications

A GNSS/INS deeply-coupled system can improve the satellite signals tracking performance by INS aiding tracking loops under dynamics. However, there was no literature available on the complete modeling of the INS branch in the INS-aided tracking loop, which caused the lack of a theoretical tool to guide the selections of inertial sensors, parameter optimization and quantitative analysis of INS-aided PLLs. This paper makes an effort on the INS branch in modeling and parameter optimization of phase-locked loops (PLLs) based on the scalar-based GNSS/INS deeply-coupled system. It establishes the transfer function between all known error sources and the PLL tracking error, which can be used to quantitatively evaluate the candidate inertial measurement unit (IMU) affecting the carrier phase tracking error. Based on that, a steady-state error model is proposed to design INS-aided PLLs and to analyze their tracking performance. Based on the modeling and error analysis, an integrated deeply-coupled hardware prototype is developed, with the optimization of the aiding information. Finally, the performance of the INS-aided PLLs designed based on the proposed steady-state error model is evaluated through the simulation and road tests of the hardware prototype

LiDAR Odometry by Deep Learning-Based Feature Points with Two-Step Pose Estimation

An accurate ego-motion estimation solution is vital for autonomous vehicles. LiDAR is widely adopted in self-driving systems to obtain depth information directly and eliminate the influence of changing illumination in the environment. In LiDAR odometry, the lack of descriptions of feature points as well as the failure of the assumption of uniform motion may cause mismatches or dilution of precision in navigation. In this study, a method to perform LiDAR odometry utilizing a bird’s eye view of LiDAR data combined with a deep learning-based feature point is proposed. Orthographic projection is applied to generate a bird’s eye view image of a 3D point cloud. Thereafter, an R2D2 neural network is employed to extract keypoints and compute their descriptors. Based on those keypoints and descriptors, a two-step matching and pose estimation is designed to keep these feature points tracked over a long distance with a lower mismatch ratio compared to the conventional strategy. In the experiment, the evaluation of the proposed algorithm on the KITTI training dataset demonstrates that the proposed LiDAR odometry can provide more accurate trajectories compared with the handcrafted feature-based SLAM (Simultaneous Localization and Mapping) algorithm. In detail, a comparison of the handcrafted descriptors is demonstrated. The difference between the RANSAC (Random Sample Consensus) algorithm and the two-step pose estimation is also demonstrated experimentally. In addition, the data collected by Velodyne VLP-16 is also evaluated by the proposed solution. The low-drift positioning RMSE (Root Mean Square Error) of 4.70 m from approximately 5 km mileage shown in the result indicates that the proposed algorithm has generalization performance on low-resolution LiDAR

LiDAR Odometry by Deep Learning-Based Feature Points with Two-Step Pose Estimation

An accurate ego-motion estimation solution is vital for autonomous vehicles. LiDAR is widely adopted in self-driving systems to obtain depth information directly and eliminate the influence of changing illumination in the environment. In LiDAR odometry, the lack of descriptions of feature points as well as the failure of the assumption of uniform motion may cause mismatches or dilution of precision in navigation. In this study, a method to perform LiDAR odometry utilizing a bird’s eye view of LiDAR data combined with a deep learning-based feature point is proposed. Orthographic projection is applied to generate a bird’s eye view image of a 3D point cloud. Thereafter, an R2D2 neural network is employed to extract keypoints and compute their descriptors. Based on those keypoints and descriptors, a two-step matching and pose estimation is designed to keep these feature points tracked over a long distance with a lower mismatch ratio compared to the conventional strategy. In the experiment, the evaluation of the proposed algorithm on the KITTI training dataset demonstrates that the proposed LiDAR odometry can provide more accurate trajectories compared with the handcrafted feature-based SLAM (Simultaneous Localization and Mapping) algorithm. In detail, a comparison of the handcrafted descriptors is demonstrated. The difference between the RANSAC (Random Sample Consensus) algorithm and the two-step pose estimation is also demonstrated experimentally. In addition, the data collected by Velodyne VLP-16 is also evaluated by the proposed solution. The low-drift positioning RMSE (Root Mean Square Error) of 4.70 m from approximately 5 km mileage shown in the result indicates that the proposed algorithm has generalization performance on low-resolution LiDAR