In the presented scenario, an autonomous surface vehicle (ASV) equipped with a laser scanner navigates on a inland pathway surrounded and crossed by man-made structures such as bridges and locks. GPS receiver present on board experiences signal loss and multipath reflections in situation when the view of the sky is obscured by a bridge or tall buildings. In both cases, a potentially dangerous situation is provoked as the robot has no or inaccurate positioning data. A sensor data processing scheme is proposed where these gaps are smoothly filled in by positioning data generated from scan matching and registration of the laser data. This article shows preliminary results of positioning data improvement during trials in harbor-river environment.
The idea of calculating relative displacement from the incremental LiDAR scan matching is not new. Tang al @cite_3 makes use of such technique for indoor navigation of a terrestrial robot. However, data collected in a building environment has many easy to exploit characteristics, such as near-perfect planes created by the walls, short sensing distances and the existence of the ground plane. The techniques using bathymetric sonar readings and a known depth map, commonly referred to as terrain-based navigation'' belong to the same family, although with a slightly different geometry of the problem (as explored by Lucido al @cite_2 , Li al @cite_12 and others).
@cite_12 @cite_3 @cite_2
2792681400 2162136131 2017444115
Abstract Considering that the terrain-aided navigation (TAN) system based on iterated closest contour point (ICCP) algorithm diverges easily when the indicative track of strapdown inertial navigation system (SINS) is large, Kalman filter is adopted in the traditional ICCP algorithm, difference between matching result and SINS output is used as the measurement of Kalman filter, then the cumulative error of the SINS is corrected in time by filter feedback correction, and the indicative track used in ICCP is improved. The mathematic model of the autonomous underwater vehicle (AUV) integrated into the navigation system and the observation model of TAN is built. Proper matching point number is designated by comparing the simulation results of matching time and matching precision. Simulation experiments are carried out according to the ICCP algorithm and the mathematic model. It can be concluded from the simulation experiments that the navigation accuracy and stability are improved with the proposed combinational algorithm in case that proper matching point number is engaged. It will be shown that the integrated navigation system is effective in prohibiting the divergence of the indicative track and can meet the requirements of underwater, long-term and high precision of the navigation system for autonomous underwater vehicles. A new scan that matches an aided Inertial Navigation System (INS) with a low-cost LiDAR is proposed as an alternative to GNSS-based navigation systems in GNSS-degraded or -denied environments such as indoor areas, dense forests, or urban canyons. In these areas, INS-based Dead Reckoning (DR) and Simultaneous Localization and Mapping (SLAM) technologies are normally used to estimate positions as separate tools. However, there are critical implementation problems with each standalone system. The drift errors of velocity, position, and heading angles in an INS will accumulate over time, and on-line calibration is a must for sustaining positioning accuracy. SLAM performance is poor in featureless environments where the matching errors can significantly increase. Each standalone positioning method cannot offer a sustainable navigation solution with acceptable accuracy. This paper integrates two complementary technologies—INS and LiDAR SLAM—into one navigation frame with a loosely coupled Extended Kalman Filter (EKF) to use the advantages and overcome the drawbacks of each system to establish a stable long-term navigation process. Static and dynamic field tests were carried out with a self-developed Unmanned Ground Vehicle (UGV) platform—NAVIS. The results prove that the proposed approach can provide positioning accuracy at the centimetre level for long-term operations, even in a featureless indoor environment. A terrain-based underwater navigation using sonar bathymetric profiles is presented. It deals with matching high-resolution local depth maps against a large on-board reference map. The matching algorithm locates the local depth map within the a priori known larger map to determine the absolute position and heading of the vehicle. Two separate approaches for this problem are presented. The first uses a contour-based representation of depth maps. Contours are extracted from both local and reference maps. Invariant attributes under rigid plane transformation are associated with each contour point, so that the problem is reduced to a point-based matching algorithm: given two point sets, find correspondences and estimate transformation between the two sets. We shall particularly focus on the formalism of partial differential equations, which is used to smooth depth maps in a morphologically invariant way and to obtain anisotropic contours. The second approach is also based on a correspondence algorithm. Here, ...