A dual-rate multi-filter algorithm for LiDAR-aided indoor navigation systems

Simultaneous localization and mapping (SLAM) has been investigated in the field of robotics for two decades, as it is considered to be an effective method for solving the positioning and mapping problem in a single framework. In the SLAM community, the Extended Kalman Filter (EKF) based SLAM and particle filter SLAM are the most mature technologies. After years of development, graph-based SLAM is becoming the most promising technology and a lot of progress has been made recently with respect to accuracy and efficiency. No matter which SLAM method is used, loop closure is a vital part for overcoming the accumulated errors. However, in 2D Light Detection and Ranging (LiDAR) SLAM, on one hand, it is relatively difficult to extract distinctive features in LiDAR scans for loop closure detection, as 2D LiDAR scans encode much less information than images; on the other hand, there is also some special mapping scenery, where no loop closure exists. Thereby, in this paper, instead of loop closure detection, we first propose the method to introduce extra control network constraint (CNC) to the back-end optimization of graph-based SLAM, by aligning the LiDAR scan center with the control vertex of the presurveyed control network to optimize all the poses of scans and submaps. Field tests were carried out in a typical urban Global Navigation Satellite System (GNSS) weak outdoor area. The results prove that the position Root Mean Square (RMS) error of the selected key points is 0.3614 m, evaluated with a reference map produced by Terrestrial Laser Scanner (TLS). Mapping accuracy is significantly improved, compared to the mapping RMS of 1.6462 m without control network constraint. Adding distance constraints of the control network to the back-end optimization is an effective and practical method to solve the drift accumulation of LiDAR front-end scan matching.

This paper presents an offline ground truth generation method using LIDAR(Light Detection and Ranging) scans and odometry. The generated ground truth allows quantitative evaluation of the performance of self-localization methods in urban areas where GNSS(Global Navigation Satellite System) cannot be trusted. The proposed method determines the vehicle pose (position and orientation) by aligning the LIDAR input with previously collected point cloud data. However, as alignment convergences are affected by the environment around the vehicle during each LIDAR scan, it can be erroneous. Incorrect estimates are removed and poses are interpolated by relying on odometry; which is locally accurate. A step by step optimization approach is adopted to yield the most accurate result. Experiments performed in a typical urban environment, with many buildings and surrounding obstacles, demonstrated the effectiveness of the proposed method.

3D LIDARs (Light Detection and Ranging) with 1.5μm nanosecond pulse lasers have been increasingly used in different applications. The main reason for their popularity is that these LIDARs have high performance while at the same time can be made eye-safe. Because the laser hazard effect on eyes or skin at this wavelength region (<1.4μm) is mainly from the thermal effect accumulated from many individual pulses over a period of seconds, scanning can effectively reduce the laser beam hazard effect from the LIDARs. Neptec LIDARs have been used in docking to the International Space Station, military helicopter landing and industrial mining applications. We have incorporated the laser safety requirements in the LIDAR design and conducted laser safety analysis for different operational scenarios. While 1.5μm is normally said to be the eye-safe wavelength, in reality a high performance 3D LIDAR needs high pulse energy, small beam size and high pulse repetition frequency (PRF) to achieve long range, high resolution and high density images. The resulting radiant exposure of its stationary beam could be many times higher than the limit for a Class 1 laser device. Without carefully choosing laser and scanning parameters, including field-of-view, scan speed and pattern, a scanning LIDAR can’t be eye- or skin-safe based only on its wavelength. This paper discusses the laser safety considerations in the design of eye-safe scanning LIDARs, including laser pulse energy, PRF, beam size and scanning parameters in two basic designs of scanning mechanisms, i.e. galvanometer based scanner and Risley prism based scanner. The laser safety is discussed in terms of device classification, nominal ocular hazard distance (NOHD) and safety glasses optical density (OD).

Routine bridge inspections require labor intensive and highly subjective visual interpretation to determine bridge deck surface condition. Light Detection and Ranging (LiDAR) a relatively new class of survey instrument has become a popular and increasingly used technology for providing as-built and inventory data in civil applications. While an increasing number of private and governmental agencies possess terrestrial and mobile LiDAR systems, an understanding of the technology’s capabilities and potential applications continues to evolve. LiDAR is a line-of-sight instrument and as such, care must be taken when establishing scan locations and resolution to allow the capture of data at an adequate resolution for defining features that contribute to the analysis of bridge deck surface condition. Information such as the location, area, and volume of spalling on deck surfaces, undersides, and support columns can be derived from properly collected LiDAR point clouds. The LiDAR point clouds contain information that can provide quantitative surface condition information, resulting in more accurate structural health monitoring. LiDAR scans were collected at three study bridges, each of which displayed a varying degree of degradation. A variety of commercially available analysis tools and an independently developed algorithm written in ArcGIS Python (ArcPy) were used to locate and quantify surface defects such as location, volume, and area of spalls. The results were visual and numerically displayed in a user-friendly web-based decision support tool integrating prior bridge condition metrics for comparison. LiDAR data processing procedures along with strengths and limitations of point clouds for defining features useful for assessing bridge deck condition are discussed. Point cloud density and incidence angle are two attributes that must be managed carefully to ensure data collected are of high quality and useful for bridge condition evaluation. When collected properly to ensure effective evaluation of bridge surface condition, LiDAR data can be analyzed to provide a useful data set from which to derive bridge deck condition information.

This paper presents a Light Detection and Ranging (LiDAR) data set that targets complex urban environments. Urban environments with high-rise buildings and congested traffic pose a significant challenge for many robotics applications. The presented data set is unique in the sense it is able to capture the genuine features of an urban environment (e.g. metropolitan areas, large building complexes and underground parking lots). Data of two-dimensional (2D) and threedimensional (3D) LiDAR, which are typical types of LiDAR sensors, are provided in the data set. The two 16-ray 3D LiDARs are tilted on both sides for maximal coverage. One 2D LiDAR faces backward while the other faces forwards to collect data of roads and buildings, respectively. Raw sensor data from Fiber Optic Gyro (FOG), Inertial Measurement Unit (IMU), and the Global Positioning System (GPS) are presented in a file format for vehicle pose estimation. The pose information of the vehicle estimated at 100 Hz is also presented after applying the graph simultaneous localization and mapping (SLAM) algorithm. For the convenience of development, the file player and data viewer in Robot Operating System (ROS) environment were also released via the web page. The full data sets are available at: http://irap.kaist.ac.kr/dataset. In this website, 3D preview of each data set is provided using WebGL.

The two main categories of light detection and ranging (LIDAR) for mapping and monitoring landslides are static and mobile devices. Static devices are commonly named ground-based LIDAR or terrestrial laser scanners (TLSs). Regarding mobile devices, the different instruments are normally classified depending on the platform configuration: either boats, cars or flying devices. There are three main types of LIDAR, corresponding to three different ways of measuring the range, for instance, the distance along the line of sight (LOS) between the sensor and the terrain. The types include: pulse LIDAR measures the time of flight (TOF) of a laser pulse; phase LIDAR uses the phase shift between the emitted and received signals; and triangulation LIDAR uses a camera to locate the laser spot on the scanned surface. Georeferencing is the process of coordinate transformation from an internal referential system relative to the LIDAR device into a real-world system of reference.

Light Detection and Ranging (LIDAR) scanning can be used to safely and remotely provide intelligence on the interior of dangerous structures for use by first responders that need to enter these structures. By scanning into structures through windows and other openings or moving the LIDAR scanning into the structure, in both cases carried by a remote controlled robotic crawler, the presence of dangerous items or personnel can be confirmed or denied. Entry and egress pathways can be determined in advance, and potential hiding/ambush locations identified. This paper describes an integrated system of a robotic crawler and LIDAR scanner. Both the scanner and the robot are wirelessly remote controlled from a single laptop computer. This includes navigation of the crawler with real-time video, self-leveling of the LIDAR platform, and the ability to raise the scanner up to heights of 2.5 m. Multiple scans can be taken from different angles to fill in detail and provide more complete coverage. These scans can quickly be registered to each other using user defi ned 'pick points', creating a single point cloud from multiple scans. Software has been developed to deconstruct the point clouds, and identify specific objects in the interior of the structure from the point cloud. Software has been developed to interactively visualize and walk through the modeled structures. Floor plans are automatically generated and a data export facility has been developed. Tests have been conducted on multiple structures, simulating many of the contingencies that a first responder would face. Keywords Hazards, laser scanning, LIDAR, model, segmentation Language: en

© 2020 by the authors. Li-censee MDPI, Basel, Switzerland. Perennial ryegrass biomass yield is an important driver of profitability for Australian dairy farmers, making it a primary goal for plant breeders. However, measuring and selecting cultivars for higher biomass yield is a major bottleneck in breeding, requiring conventional methods that may be imprecise, laborious, and/or destructive. For forage breeding programs to adopt phenomic technologies for biomass estimation, there exists the need to develop, integrate, and validate sensor-based data collection that is aligned with the growth characteristics of plants, plot design and size, and repeated measurements across the growing season to reduce the time and cost associated with the labor involved in data collection. A fully automated phenotyping platform (DairyBioBot) utilizing an unmanned ground vehicle (UGV) equipped with a ground-based Light Detection and Ranging (LiDAR) sensor and Real-Time Kinematic (RTK) positioning system was developed for the accurate and efficient measurement of plant volume as a proxy for biomass in large-scale perennial ryegrass field trials. The field data were collected from a perennial ryegrass row trial of 18 experimental varieties in 160 plots (three rows per plot). DairyBioBot utilized mission planning software to autonomously capture high-resolution LiDAR data and Global Positioning System (GPS) recordings. A custom developed data processing pipeline was used to generate a plant volume estimate from LiDAR data connected to GPS coordinates. A high correlation between LiDAR plant volume and biomass on a Fresh Mass (FM) basis was observed with the coefficient of determination of R2 = 0.71 at the row level and R2 = 0.73 at the plot level. This indicated that LiDAR plant volume is strongly correlated with biomass and therefore the DairyBioBot demonstrates the utility of an autonomous platform to estimate in-field biomass for perennial ryegrass. It is likely that no single platform will be optimal to measure plant biomass from landscape to plant scales; the development and application of autonomous ground-based platforms is of greatest benefit to forage breeding programs.

Remotely Operated Underwater Vehicles (ROUVs) are increasingly important for high-resolution surveying of narrow shipping lanes. This paper presents 3Clifs, a LiDAR- and AI-enhanced ROUV designed for near-real-time topographic mapping and navigation support in shallow, constrained waterways, demonstrated at three cliff sites in the Suez Canal. The system integrates three-dimensional Light Detection and Ranging (LiDAR) scanning, an Inertial Measurement Unit (IMU), and an onboard processor running the Robot Operating System (ROS) for Simultaneous Localization and Mapping (SLAM). To address data loss from underwater LiDAR (caused by scattering and reflection), we introduce an AI-driven optimisation module that reconstructs missing point cloud data and improves SLAM continuity. We also report propulsion and propeller design changes (propeller v05_1) that reduce flow turbulence and improve scan stability. We compare our approach to sonar-only ROUV mapping and to recent ROUV/LiDAR studies using metrics including point-cloud completeness, SLAM continuity, and navigation-path deviation. The main contributions are: (i) an integrated LiDAR, ROS and AI pipeline for underwater SLAM with missing-point recovery; (ii) a propulsion configuration optimized for LiDAR scanning stability; and (iii) a real-world Suez Canal case study demonstrating practical benefits for narrow-lane navigation.

Design and experimental validation of a robust model predictive control for the optimal trajectory tracking of a small-scale autonomous bulldozer

The Mobile Mapping System (MMS) is widely used when mapping urban environment. The critical challenge for mapping accuracy is at localization accuracy under highly sporadic global positioning system (GPS) signal. To tackle this issue, approaches often rely on cameras and Light Detection and Ranging (LiDAR)s to exploit visual and spatial features in the environment. Among many sensors, this paper focuses on the use of LiDAR, especially evaluating the LiDAR types and mechanical configurations. In this paper, we compare two typical LiDAR configurations, push-broom (2D) and 360 scanning (3D) style, in terms of the resulting mapping performance. Resulting maps from two configurations over the same place are directly compared to evaluate characteristic of each LiDAR configuration.

&lt;span lang="EN-US"&gt;In recent years, there has been a strong demand for self-driving cars. For safe navigation, self-driving cars need both precise localization and robust mapping. While global navigation satellite system (GNSS) can be used to locate vehicles, it has some limitations, such as satellite signal absence (tunnels and caves), which restrict its use in urban scenarios. Simultaneous localization and mapping (SLAM) are an excellent solution for identifying a vehicle’s position while at the same time constructing a representation of the environment. SLAM-based visual and light detection and ranging (LIDAR) refer to using cameras and LIDAR as source of external information. This paper presents an implementation of SLAM algorithm for building a map of environment and obtaining car’s trajectory using LIDAR scans. A detailed overview of current visual and LIDAR SLAM approaches has also been provided and discussed. Simulation results referred to LIDAR scans indicate that SLAM is convenient and helpful in localization and mapping.&lt;/span&gt;

The work conducted in this thesis is a part of an EU Horizon 2020 research initiative project known as DigiArt. This part of the DigiArt project presents and explores the design, formulation and implementation of probabilistically orientated state estimation algorithms with focus towards unmanned system positioning and three-dimensional (3D) mapping. State estimation algorithms are considered an influential aspect of any dynamic system with autonomous capabilities. Possessing the ability to predictively estimate future conditions enables effective decision making and anticipating any possible changes in the environment. Initial experimental procedures utilised a wireless ultra-wide band (UWB) based communication network. This system functioned through statically situated beacon nodes used to localise a dynamically operating node. The simultaneous deployment of this UWB network, an unmanned system and a Robotic Total Station (RTS) with active and remote tracking features enabled the characterisation of the range measurement errors associated with the UWB network. These range error metrics were then integrated into an Range based Extended Kalman Filter (R-EKF) state estimation algorithm with active outlier identification to outperform the native approach used by the UWB system for two-dimensional (2D) pose estimation.The study was then expanded to focus on state estimation in 3D, where a Six Degreeof-Freedom EKF (6DOF-EKF) was designed using Light Detection and Ranging (LiDAR) as its primary observation source. A two step method was proposed which extracted information between consecutive LiDAR scans. Firstly, motion estimation concerning Cartesian states x, y and the unmanned system’s heading (ψ) was achieved through a 2D feature matching process. Secondly, the extraction and alignment of ground planes from the LiDAR scan enabled motion extraction for Cartesian position z and attitude angles roll (θ) and pitch (φ). Results showed that the ground plane alignment failed when two scans were at 10.5◦ offset. Therefore, to overcome this limitation an Error State Kalman Filter (ES-KF) was formulated and deployed as a sub-system within the 6DOF-EKF. This enabled the successful tracking of roll, pitch and the calculation of z. The 6DOF-EKF was seen to outperform the R-EKF and the native UWB approach, as it was much more stable, produced less noise in its position estimations and provided 3D pose estimation.

Lack of coordination between driver and road geometry results in driver errors and crashes. Road geometric data constitute one of the primary requirements for safety analysis and improvement projects. A systematic literature review is presented here to identify existing methodologies for road geometric data extraction. Methodologies based on Global Positioning System (GPS), geographic information system (GIS) maps, AutoCAD digital maps, satellite imagery, inertial measurement unit, light detection and ranging (LiDAR) and vision technology were found employing manual, semi-automatic and automatic algorithms for extraction of horizontal alignment features of roads. A multi-criteria analysis in terms of device/software cost, data treatment cost and time acquisition was performed for the methodologies using an expert survey. Survey responses were analysed to rank the methodologies for minimum cost and time using an analytical hierarchical process. GPS- and GIS maps-based methodologies were the most economical, whereas the LiDAR-based methodology was the least economical. Overall, the findings provide valuable insights into components of existing methodologies. These findings could benefit practitioners, policymakers, enforcement authorities, vehicle manufacturers and researchers in the judicious selection of an appropriate methodology. An inventory of road geometric data could also be established to develop an intelligent transportation system by combining vehicle, road and driver in effective communication through information technologies.

The application of unmanned vehicles in civilian and military fields is increasingly widespread. Traditionally, unmanned vehicles primarily rely on Global Positioning Systems (GPSs) for positioning; however, GPS signals can be limited or completely lost in conditions such as building obstructions, indoor environments, or electronic interference. In addition, countries are actively developing GPS jamming and deception technologies for military applications, making precise positioning and navigation of unmanned vehicles in GPS-denied or constrained environments a critical issue that needs to be addressed. In this work, authors propose a method based on Visual–Inertial Odometry (VIO), integrating the extended Kalman filter (EKF), an Inertial Measurement Unit (IMU), optical flow, and feature matching to achieve drone localization in GPS-denied environments. The proposed method uses the heading angle and acceleration data obtained from the IMU as the state prediction for the EKF, and estimates relative displacement using optical flow. It further corrects the optical flow calculation errors through IMU rotation compensation, enhancing the robustness of visual odometry. Additionally, when re-selecting feature points for optical flow, it combines a KAZE feature matching technique for global position correction, reducing drift errors caused by long-duration flight. The authors also employ an adaptive noise adjustment strategy that dynamically adjusts the internal state and measurement noise matrices of the EKF based on the rate of change in heading angle and feature matching reliability, allowing the drone to maintain stable positioning in various flight conditions. According to the simulation results, the proposed method is able to effectively estimate the flight trajectory of drones without GPS. Compared to results that rely solely on optical flow or feature matching, it significantly reduces cumulative errors. This makes it suitable for urban environments, forest areas, and military applications where GPS signals are limited, providing a reliable solution for autonomous navigation and positioning of drones.