scholarly journals GNSS/INS/LiDAR-SLAM Integrated Navigation System Based on Graph Optimization

2019 ◽  
Vol 11 (9) ◽  
pp. 1009 ◽  
Author(s):  
Le Chang ◽  
Xiaoji Niu ◽  
Tianyi Liu ◽  
Jian Tang ◽  
Chuang Qian

A Global Navigation Satellite System (GNSS)/Inertial Navigation System (INS)/Light Detection and Ranging (LiDAR)-Simultaneous Localization and Mapping (SLAM) integrated navigation system based on graph optimization is proposed and implemented in this paper. The navigation results are obtained by the information fusion of the GNSS position, Inertial Measurement Unit (IMU) preintegration result and the relative pose from the 3D probability map matching with graph optimizing. The sliding window method was adopted to ensure that the computational load of the graph optimization does not increase with time. Land vehicle tests were conducted, and the results show that the proposed GNSS/INS/LiDAR-SLAM integrated navigation system can effectively improve the navigation positioning accuracy compared to GNSS/INS and other current GNSS/INS/LiDAR methods. During the simulation of one-minute periods of GNSS outages, compared to the GNSS/INS integrated navigation system, the root mean square (RMS) of the position errors in the North and East directions of the proposed navigation system are reduced by approximately 82.2% and 79.6%, respectively, and the position error in the vertical direction and attitude errors are equivalent. Compared to the benchmark method of GNSS/INS/LiDAR-Google Cartographer, the RMS of the position errors in the North, East and vertical directions decrease by approximately 66.2%, 63.1% and 75.1%, respectively, and the RMS of the roll, pitch and yaw errors are reduced by approximately 89.5%, 92.9% and 88.5%, respectively. Furthermore, the relative position error during the GNSS outage periods is reduced to 0.26% of the travel distance for the proposed method. Therefore, the GNSS/INS/LiDAR-SLAM integrated navigation system proposed in this paper can effectively fuse the information of GNSS, IMU and LiDAR and can significantly mitigate the navigation error, especially for cases of GNSS signal attenuation or interruption.

Sensors ◽  
2020 ◽  
Vol 20 (17) ◽  
pp. 4702 ◽  
Author(s):  
Le Chang ◽  
Xiaoji Niu ◽  
Tianyi Liu

In this paper, we proposed a multi-sensor integrated navigation system composed of GNSS (global navigation satellite system), IMU (inertial measurement unit), odometer (ODO), and LiDAR (light detection and ranging)-SLAM (simultaneous localization and mapping). The dead reckoning results were obtained using IMU/ODO in the front-end. The graph optimization was used to fuse the GNSS position, IMU/ODO pre-integration results, and the relative position and relative attitude from LiDAR-SLAM to obtain the final navigation results in the back-end. The odometer information is introduced in the pre-integration algorithm to mitigate the large drift rate of the IMU. The sliding window method was also adopted to avoid the increasing parameter numbers of the graph optimization. Land vehicle tests were conducted in both open-sky areas and tunnel cases. The tests showed that the proposed navigation system can effectually improve accuracy and robustness of navigation. During the navigation drift evaluation of the mimic two-minute GNSS outages, compared to the conventional GNSS/INS (inertial navigation system)/ODO integration, the root mean square (RMS) of the maximum position drift errors during outages in the proposed navigation system were reduced by 62.8%, 72.3%, and 52.1%, along the north, east, and height, respectively. Moreover, the yaw error was reduced by 62.1%. Furthermore, compared to the GNSS/IMU/LiDAR-SLAM integration navigation system, the assistance of the odometer and non-holonomic constraint reduced vertical error by 72.3%. The test in the real tunnel case shows that in weak environmental feature areas where the LiDAR-SLAM can barely work, the assistance of the odometer in the pre-integration is critical and can effectually reduce the positioning drift along the forward direction and maintain the SLAM in the short-term. Therefore, the proposed GNSS/IMU/ODO/LiDAR-SLAM integrated navigation system can effectually fuse the information from multiple sources to maintain the SLAM process and significantly mitigate navigation error, especially in harsh areas where the GNSS signal is severely degraded and environmental features are insufficient for LiDAR-SLAM.


2017 ◽  
Vol 2017 ◽  
pp. 1-9 ◽  
Author(s):  
Huisheng Liu ◽  
Zengcai Wang ◽  
Susu Fang ◽  
Chao Li

A constrained low-cost SINS/OD filter aided with magnetometer is proposed in this paper. The filter is designed to provide a land vehicle navigation solution by fusing the measurements of the microelectromechanical systems based inertial measurement unit (MEMS IMU), the magnetometer (MAG), and the velocity measurement from odometer (OD). First, accelerometer and magnetometer integrated algorithm is studied to stabilize the attitude angle. Next, a SINS/OD/MAG integrated navigation system is designed and simulated, using an adaptive Kalman filter (AKF). It is shown that the accuracy of the integrated navigation system will be implemented to some extent. The field-test shows that the azimuth misalignment angle will diminish to less than 1°. Finally, an outliers detection algorithm is studied to estimate the velocity measurement bias of the odometer. The experimental results show the enhancement in restraining observation outliers that improves the precision of the integrated navigation system.


2012 ◽  
Vol 245 ◽  
pp. 323-329 ◽  
Author(s):  
Muhammad Ushaq ◽  
Jian Cheng Fang

Inertial navigation systems exhibit position errors that tend to grow with time in an unbounded mode. This degradation is due, in part, to errors in the initialization of the inertial measurement unit and inertial sensor imperfections such as accelerometer biases and gyroscope drifts. Mitigation to this growth and bounding the errors is to update the inertial navigation system periodically with external position (and/or velocity, attitude) fixes. The synergistic effect is obtained through external measurements updating the inertial navigation system using Kalman filter algorithm. It is a natural requirement that the inertial data and data from the external aids be combined in an optimal and efficient manner. In this paper an efficient method for integration of Strapdown Inertia Navigation System (SINS), Global Positioning System (GPS) and Doppler radar is presented using a centralized linear Kalman filter by treating vector measurements with uncorrelated errors as scalars. Two main advantages have been obtained with this improved scheme. First is the reduced computation time as the number of arithmetic computation required for processing a vector as successive scalar measurements is significantly less than the corresponding number of operations for vector measurement processing. Second advantage is the improved numerical accuracy as avoiding matrix inversion in the implementation of covariance equations improves the robustness of the covariance computations against round off errors.


2012 ◽  
Vol 241-244 ◽  
pp. 439-443
Author(s):  
Fang Chen ◽  
Yun Xi Xu

It is important that scene matching algorithm should satisfy the requirements of real-time, robustness and high-precision for inertial integrated navigation system. And considering the serious distortion and speckle noises of SAR images, we proposed a new scene matching algorithm for the SAR/INS integrated navigation system with high-speed and robustness based on Oriented FAST and Rotated BRIEF (ORB). We started by detecting scale-space FAST-based features in combination with an efficiently computed orientation in the image. Then, we calculated feature point's Rotation-Aware BRIEF descriptor which performs well with rotation and match features by computing Hamming distance between descriptors. Finally, we adopted GroupSAC which are proposed recently to remove the false matching points and the least square algorithm for getting the distortion transformation parameters that are the aircraft position errors and rotation transform parameters between real image and reference image. Experimental results on real SAR images indicate that our algorithm is invariant to various image transformations due to rotation and scale, and also robust to speckle noise and extremely efficient to compute, better than SIFT in many situations. Therefore, our algorithm can meet the high performance needs for matching navigation in the SAR/INS integrated navigation system.


2013 ◽  
Vol 278-280 ◽  
pp. 1719-1722 ◽  
Author(s):  
Xiao Yu Zhang ◽  
Chun Lei Song

A new scheme of small integrated navigation system based on micro inertial measurement unit (MIMU), global position system (GPS) is presented. The characteristic of these sensors and the structure of system are introduced respectively. The TI high performance floating point DSP TMS320C6713B is used as core processor, which is designed to realize both the data collecting and the navigation calculating. According to the error models of inertial navigation system, an integrated navigation algorithm used Kalman filter is proposed to fuse the information from all of the sensors. The simulation test results show the feasibility of the system design.


2013 ◽  
Vol 411-414 ◽  
pp. 912-916 ◽  
Author(s):  
Ying Chen ◽  
Xia Jiang Zhang ◽  
Yuan Yuan Xue ◽  
Zhen Kang ◽  
Ting Shang

Strap-down INS is composed of fiber gyroscope. Position error propagation equation and position update algorithm of dead reckoning is deduced in this paper. The Kalman filter is proposed for compensation error of integrated system. The difference of velocity between INS and DR is used as the input of Kalman filter, attitude error, velocity error, position error and scale factor error are to be estimated which compensate and rectify the errors of integrated navigation system. By carrying out experiment upon vehicular navigation system in use of Kalman filter, the errors of integrated navigation system are estimated accurately. Experiment result show that the method not only can effectively improve precision of the system, but also is simple and convenient, so it is more suitable for practical application.


2013 ◽  
Vol 846-847 ◽  
pp. 378-382
Author(s):  
Hao Ran Lei ◽  
Shuai Chen ◽  
Yao Wei Chang ◽  
Lei Jie Wang

In the process of developing guided munitions, ground test can only verify the performance of integrated navigation system in low dynamic condition, and its costly and risky to use means of authentication such as flight test and throw experiment. This paper proposes a kind of hardware-in-the-loop simulation (HILS) scheme with tri-axial turntable for verifying the performance of navigation system in high dynamic condition. It respectively uses quaternion method and four-sample rotation vector algorithm as attitude updating algorithms for comparison. On the basis of analyzing the characteristics of some tactical missile and the HILS system, the error sources of integrated navigation system in the simulation with turntable and that without turntable are discussed in detail. The results of HILS show that integrated navigation system is of good performance under high dynamic environment; moreover, for the fiber optic gyroscope (FOG) inertial measurement unit (IMU) which outputs angular rate, quaternion method is better than four-sample rotation vector algorithm.


2016 ◽  
Vol 70 (2) ◽  
pp. 291-308 ◽  
Author(s):  
Qiang Xiao ◽  
Huimin Fu ◽  
Zhihua Wang ◽  
Yongbo Zhang

Accurate navigation systems are required for future pinpoint Mars landing missions. A radio ranging augmented Inertial Measurement Unit (IMU) integrated navigation system concept is considered for the Mars entry navigation. The uncertain system parameters associated with the Three Degree-Of-Freedom (3-DOF) dynamic model, and the measurement systematic errors are considered. In order to improve entry navigation accuracy, this paper presents the Multiple Model Adaptive Rank Estimation (MMARE) filter of radio beacons/IMU integrated navigation system. 3-DOF simulation results show that the performances of the proposed navigation filter method, 70·39 m estimated altitude error and 15·74 m/s estimated velocity error, fulfill the need of future pinpoint Mars landing missions.


2013 ◽  
Vol 332 ◽  
pp. 79-85
Author(s):  
Outamazirt Fariz ◽  
Muhammad Ushaq ◽  
Yan Lin ◽  
Fu Li

Strapdown Inertial Navigation Systems (SINS) displays position errors which grow with time in an unbounded manner. This degradation is due to the errors in the initialization of the inertial measurement unit, and inertial sensor imperfections such as accelerometer biases and gyroscope drifts. Improvement to this unbounded growth in errors can be made by updating the inertial navigation system solutions periodically with external position fixes, velocity fixes, attitude fixes or any combination of these fixes. The increased accuracy is obtained through external measurements updating inertial navigation system using Kalman filter algorithm. It is the basic requirement that the inertial data and data from the external aids be combined in an optimal and efficient manner. In this paper an efficient method for integration of Strapdown Inertial Navigation System (SINS), Global Positioning System (GPS) is presented using a centralized linear Kalman filter.


2012 ◽  
Vol 19 (2) ◽  
pp. 71-98 ◽  
Author(s):  
Roberto Sabatini ◽  
Celia Bartel ◽  
Anish Kaharkar ◽  
Tesheen Shaid ◽  
Leopoldo Rodriguez ◽  
...  

Abstract In this paper we present a new low-cost navigation system designed for small size Unmanned Aerial Vehicles (UAVs) based on Vision-Based Navigation (VBN) and other avionics sensors. The main objective of our research was to design a compact, light and relatively inexpensive system capable of providing the Required Navigation Performance (RNP) in all phases of flight of a small UAV, with a special focus on precision approach and landing, where Vision Based Navigation (VBN) techniques can be fully exploited in a multisensor integrated architecture. Various existing techniques for VBN were compared and the Appearance-Based Approach (ABA) was selected for implementation. Feature extraction and optical flow techniques were employed to estimate flight parameters such as roll angle, pitch angle, deviation from the runway and body rates. Additionally, we addressed the possible synergies between VBN, Global Navigation Satellite System (GNSS) and MEMS-IMU (Micro-Electromechanical System Inertial Measurement Unit) sensors, as well as the aiding from Aircraft Dynamics Models (ADMs). In particular, by employing these sensors/models, we aimed to compensate for the shortcomings of VBN and MEMS-IMU sensors in high-dynamics attitude determination tasks. An Extended Kalman Filter (EKF) was developed to fuse the information provided by the different sensors and to provide estimates of position, velocity and attitude of the UAV platform in real-time. Two different integrated navigation system architectures were implemented. The first used VBN at 20 Hz and GPS at 1 Hz to augment the MEMS-IMU running at 100 Hz. The second mode also included the ADM (computations performed at 100 Hz) to provide augmentation of the attitude channel. Simulation of these two modes was accomplished in a significant portion of the AEROSONDE UAV operational flight envelope and performing a variety of representative manoeuvres (i.e., straight climb, level turning, turning descent and climb, straight descent, etc.). Simulation of the first integrated navigation system architecture (VBN/IMU/GPS) showed that the integrated system can reach position, velocity and attitude accuracies compatible with CAT-II precision approach requirements. Simulation of the second system architecture (VBN/IMU/GPS/ADM) also showed promising results since the achieved attitude accuracy was higher using the ADM/VBS/IMU than using VBS/IMU only. However, due to rapid divergence of the ADM virtual sensor, there was a need for frequent re-initialisation of the ADM data module, which was strongly dependent on the UAV flight dynamics and the specific manoeuvring transitions performed


Sign in / Sign up

Export Citation Format

Share Document