Monte Carlo Localization Research Articles

Map Construction and Positioning Method for LiDAR SLAM-Based Navigation of an Agricultural Field Inspection Robot

In agricultural field inspection robots, constructing accurate environmental maps and achieving precise localization are essential for effective Light Detection And Ranging (LiDAR) Simultaneous Localization And Mapping (SLAM) navigation. However, navigating in occluded environments, such as mapping distortion and substantial cumulative errors, presents challenges. Although current filter-based algorithms and graph optimization-based algorithms are exceptionally outstanding, they exhibit a high degree of complexity. This paper aims to investigate precise mapping and localization methods for robots, facilitating accurate LiDAR SLAM navigation in agricultural environments characterized by occlusions. Initially, a LiDAR SLAM point cloud mapping scheme is proposed based on the LiDAR Odometry And Mapping (LOAM) framework, tailored to the operational requirements of the robot. Then, the GNU Image Manipulation Program (GIMP) is employed for map optimization. This approach simplifies the map optimization process for autonomous navigation systems and aids in converting the Costmap. Finally, the Adaptive Monte Carlo Localization (AMCL) method is implemented for the robot’s positioning, using sensor data from the robot. Experimental results highlight that during outdoor navigation tests, when the robot operates at a speed of 1.6 m/s, the average error between the mapped values and actual measurements is 0.205 m. The results demonstrate that our method effectively prevents navigation mapping distortion and facilitates reliable robot positioning in experimental settings.

Mapping and Localization of Autonomous Mobile Robots in Simulated Indoor Environments

Autonomously making a map, localizing within it, and planning with it are fundamental problems in mobile robotics. Every autonomous mobile robot system must include a solution to all three problems. These three problems are interconnected, with simultaneous localization and mapping (SLAM) being a well-known issue. However, there is indeed a growing and developing realization in the research field that path planning how a robot goes about mapping and finding an environment (and then operating in the environment such as starting to the destination point) can avoid degenerate conditions and greatly reduce SLAM complexity. In this paper, the implementation of an autonomous mobile robot system for indoor environments using open-source ROS packages and a combination of cartography algorithm and adaptive Monte Carlo localization (AMCL) algorithms has been implemented. The system addresses the challenge of developing three components such as mapping, localization, and path planning systems for indoor autonomous mobile robots. The mapping module creates a global map using the cartography ROS package and SLAM algorithm. The localization module estimates the robot's pose using the AMCL approach. The planning module generates collision-free trajectories and control commands using the moving base ROS package. The experimental results demonstrate the effectiveness of this approach and its valuable contribution to the robotics field. The cartography algorithm mapping algorithm generates accurate and reliable maps, while the localization algorithm successfully determines the robot's position with good performance. Additionally, the path planning algorithm effectively avoids both static and dynamic obstacles, ensuring smooth navigation in the environment.

Optimal path planning using bidirectional rapidly-exploring random tree star-dynamic window approach (BRRT*-DWA) with adaptive Monte Carlo localization (AMCL) for mobile robot

Path planning is an important task for mobileF service robots. Most of the available path-planning algorithms are applicable only in static environments. Achieving path planning becomes a difficult task in an unknown, dynamic environment. To solve the path planning problem in an unknown dynamic environment, this paper proposes a Bidirectional Rapidly-exploring Random Tree Star-Dynamic Window Approach (BRRT*-DWA) algorithm with Adaptive Monte Carlo Localization (AMCL). Bidirectional Rapidly-exploring Random Tree Star(BRRT*) is used to generate an optimal global path plan, Dynamic Window Approach(DWA) is a local planner and Adaptive Monte Carlo Localization(AMCL) is used as a localization technique. The robot can navigate using the map file of the unknown environment created by Simultaneous Localization And Mapping (SLAM) and the data from the Light Detection and Ranging (LiDAR) sensor while avoiding dynamic and static obstacles. In addition, the object identification algorithm You Only Look Once (YOLO) was adopted, trained, and used for the robot to recognize objects and people. Results obtained from both simulation and experiment show the proposed method can achieve better performance in a dynamic environment compared with other state-of-the-art algorithms.

Adaptive Monte Carlo Localization in Unstructured Environment via the Dimension Chain of Semantic Corners

Adaptive Monte Carlo Localization in Unstructured Environment via the Dimension Chain of Semantic Corners

Path Planning for Autonomous Mobile Robot Using Intelligent Algorithms

Machine learning technologies are being integrated into robotic systems faster to enhance their efficacy and adaptability in dynamic environments. The primary goal of this research was to propose a method to develop an Autonomous Mobile Robot (AMR) that integrates Simultaneous Localization and Mapping (SLAM), odometry, and artificial vision based on deep learning (DL). All are executed on a high-performance Jetson Nano embedded system, specifically emphasizing SLAM-based obstacle avoidance and path planning using the Adaptive Monte Carlo Localization (AMCL) algorithm. Two Convolutional Neural Networks (CNNs) were selected due to their proven effectiveness in image and pattern recognition tasks. The ResNet18 and YOLOv3 algorithms facilitate scene perception, enabling the robot to interpret its environment effectively. Both algorithms were implemented for real-time object detection, identifying and classifying objects within the robot’s environment. These algorithms were selected to evaluate their performance metrics, which are critical for real-time applications. A comparative analysis of the proposed DL models focused on enhancing vision systems for autonomous mobile robots. Several simulations and real-world trials were conducted to evaluate the performance and adaptability of these models in navigating complex environments. The proposed vision system with CNN ResNet18 achieved an average accuracy of 98.5%, a precision of 96.91%, a recall of 97%, and an F1-score of 98.5%. However, the YOLOv3 model achieved an average accuracy of 96%, a precision of 96.2%, a recall of 96%, and an F1-score of 95.99%. These results underscore the effectiveness of the proposed intelligent algorithms, robust embedded hardware, and sensors in robotic applications. This study proves that advanced DL algorithms work well in robots and could be used in many fields, such as transportation and assembly. As a consequence of the findings, intelligent systems could be implemented more widely in the operation and development of AMRs.

Autonomous navigation system for greenhouse tomato picking robots based on laser SLAM

Aiming at the specific operation path cruising problem of greenhouse tomato picking robots, this paper designs a laser SLAM (Simultaneous Localization And Mapping)-based autonomous navigation system for greenhouse tomato picking robots.The autonomous navigation system utilizes LiDAR to detect the greenhouse environment, creates an environment map with the Gmapping algorithm employing particle filtering, locates the robot with the AMCL (Adaptive Monte Carlo Localization) algorithm, devises the robot's path for picking tasks with the A* algorithm, and dynamically navigates around obstacles during operations with the DWA (Dynamic Window Approach) algorithm. The greenhouse experiment revealed that the robot's average deviance for both directions (X and Y) is 2.87 and 0.80 centimeters, respectively, when traveling a 320 centimeter path. On the other hand, its average variation across the directions of X and Y is 1.48 versus 1.08 centimeters when it passes through a 40 centimeter zone. The robot exhibits averaged variations of 1.73 and 2.24 millimeters in the X and Y axes, each, when navigating a 40-centimeter-radius turn. Furthermore, the robot exhibits average variations of 1.12 centimeters in the X and 0.78 centimeters in the Y directions when it follows a certain "S"-shaped course. Based on the fulfillment of prescribed path cruising, the system has a high level of navigation and positioning accuracy, better meeting the requirements for greenhouse tomato harvesting robot direction and placement.

Multi-sensor fusion based wheeled robot research on indoor positioning method

In response to the poor positioning performance and errors of the wheeled robot under a single sensor, a combination of wheel odometry dead reckoning, Inertial Measurement Unit (IMU) heading angle information, and map environment information obtained from LiDAR is used for indoor positioning of the wheeled robot. By using data from multiple sensors, errors are reduced and positioning accuracy is improved. The results show that combining the Extended Kalman Filter (EKF), Gmapping algorithm, and Adaptive Monte Carlo Localization (AMCL) reduces the relative error by 8.35 % compared to the single wheel odometry heading calculation method. Compared with the EKF fusion method for dead reckoning and inertial measurement unit heading angle information, the relative error is reduced by 4 %, and there is no cumulative trend in angle error. This effectively addresses the challenge of cumulative errors in indoor positioning within environments that lack base stations, thereby enhancing accuracy and reliability in such specialized conditions.

L-PCM: Localization and Point Cloud Registration-Based Method for Pose Calibration of Mobile Robots

The autonomous navigation of mobile robots contains three parts: map building, global localization, and path planning. Precise pose data directly affect the accuracy of global localization. However, the cumulative error problems of sensors and various estimation strategies cause the pose to have a large gap in data accuracy. To address these problems, this paper proposes a pose calibration method based on localization and point cloud registration, which is called L-PCM. Firstly, the method obtains the odometer and IMU (inertial measurement unit) data through the sensors mounted on the mobile robot and uses the UKF (unscented Kalman filter) algorithm to filter and fuse the odometer data and IMU data to obtain the estimated pose of the mobile robot. Secondly, the AMCL (adaptive Monte Carlo localization) is improved by combining the UKF fusion model of the IMU and odometer to obtain the modified global initial pose of the mobile robot. Finally, PL-ICP (point to line-iterative closest point) point cloud registration is used to calibrate the modified global initial pose to obtain the global pose of the mobile robot. Through simulation experiments, it is verified that the UKF fusion algorithm can reduce the influence of cumulative errors and the improved AMCL algorithm can optimize the pose trajectory. The average value of the position error is about 0.0447 m, and the average value of the angle error is stabilized at about 0.0049 degrees. Meanwhile, it has been verified that the L-PCM is significantly better than the existing AMCL algorithm, with a position error of about 0.01726 m and an average angle error of about 0.00302 degrees, effectively improving the accuracy of the pose.

Open source robot localization for nonplanar environments

AbstractThe operational environments in which a mobile robot executes its missions often exhibit nonflat terrain characteristics, encompassing outdoor and indoor settings featuring ramps and slopes. In such scenarios, the conventional methodologies employed for localization encounter novel challenges and limitations. This study delineates a localization framework incorporating ground elevation and incline considerations, deviating from traditional two‐dimensional localization paradigms that may falter in such contexts. In our proposed approach, the map encompasses elevation and spatial occupancy information, employing Gridmaps and Octomaps. At the same time, the perception model is designed to accommodate the robot's inclined orientation and the potential presence of ground as an obstacle, besides usual structural and dynamic obstacles. We provide an implementation of our approach fully working with Nav2, ready to replace the baseline Adaptative Monte Carlo Localization (AMCL) approach when the robot is in nonplanar environments. Our methodology was rigorously tested in both simulated environments and through practical application on actual robots, including the Tiago and Summit XL models, across various settings ranging from indoor and outdoor to flat and uneven terrains. Demonstrating exceptional precision, our approach yielded error margins below 10 cm and 0.05 radians in indoor settings and less than 1.0 m in extensive outdoor routes. While our results exhibit a slight improvement over AMCL in indoor environments, the enhancement in performance is significantly more pronounced when compared to three‐dimensional simultaneous localization and mapping algorithms. This underscores the considerable robustness and efficiency of our approach, positioning it as an effective strategy for mobile robots tasked with navigating expansive and intricate indoor/outdoor environments.

Monte Carlo localization based on off-line feature matching and improved particle swarm optimization for mobile robots

Monte Carlo localization based on off-line feature matching and improved particle swarm optimization for mobile robots

Enhanced resampling scheme for Monte Carlo localization

Enhanced resampling scheme for Monte Carlo localization

Online as-Built Building Information Model Update for Robotic Monitoring in Construction Sites

Today, automated techniques for the update of as-built Building Information Models (BIM) make use of offline algorithms restricting the update frequency to an extent where continuous monitoring becomes nearly impossible. To address this problem, we propose a new method for robotic monitoring that updates an as-built BIM in real-time by solving a Simultaneous Localization and Mapping (SLAM) problem where the map is represented as a collection of elements from the as-planned BIM. The suggested approach is based on the Rao-Blackwellized Particle Filter (RBPF) which enables explicit injection of prior knowledge from the building’s construction schedule, i.e., from a 4D BIM, or its elements’ spatial relations. In the methods section we describe the benefits of using an exact inverse sensor model that provides a measure for the existence probability of elements while considering the entire probabilistic existence belief map. We continue by outlining robustification techniques that include both geometrical and temporal dimensions and present how we account for common pose and shape mistakes in constructed elements. Additionally, we show that our method reduces to the standard Monte Carlo Localization (MCL) in known areas. We conclude by presenting simulation results of the proposed method and comparing it to adjacent alternatives.

Improvement in Monte Carlo localization using information theory and statistical approaches

Monte Carlo localization methods deploy a particle filter to resolve a hidden Markov process based on recursive Bayesian estimation, which approximates the internal states of a dynamic system given observation data. When the observed data are corrupted by outliers, the particle filter’s performance may deteriorate, preventing the algorithm from accurately computing dynamic system states such as a robot’s position, which in turn reduces the accuracy of the localization and navigation. In this paper, the notion of information entropy is used to identify outliers. Then, a probability-based approach is used to remove the discovered outliers. In addition, a new mutation process is added to the localization algorithm to exploit the posterior probability density function in order to actively detect the high-likelihood region. The goal of incorporating the mutation operator into this method is to solve the problem of algorithm impoverishment which is due to insufficient representation of the complete probability density function. Simulation experiments are used to confirm the effectiveness of the proposed techniques. They also are employed to predict the remaining viability of a lithium-ion battery. Furthermore, in an experimental study, the modified Monte Carlo localization algorithm was applied to a mobile robot to demonstrate the local planner’s improved accuracy. The test results indicate that developed techniques are capable of effectively capturing the dynamic behavior of a system and accurately tracking its characteristics.

Hippocampal formation-inspired global self-localization: quick recovery from the kidnapped robot problem from an egocentric perspective.

It remains difficult for mobile robots to continue accurate self-localization when they are suddenly teleported to a location that is different from their beliefs during navigation. Incorporating insights from neuroscience into developing a spatial cognition model for mobile robots may make it possible to acquire the ability to respond appropriately to changing situations, similar to living organisms. Recent neuroscience research has shown that during teleportation in rat navigation, neural populations of place cells in the cornu ammonis-3 region of the hippocampus, which are sparse representations of each other, switch discretely. In this study, we construct a spatial cognition model using brain reference architecture-driven development, a method for developing brain-inspired software that is functionally and structurally consistent with the brain. The spatial cognition model was realized by integrating the recurrent state-space model, a world model, with Monte Carlo localization to infer allocentric self-positions within the framework of neuro-symbol emergence in the robotics toolkit. The spatial cognition model, which models the cornu ammonis-1 and -3 regions with each latent variable, demonstrated improved self-localization performance of mobile robots during teleportation in a simulation environment. Moreover, it was confirmed that sparse neural activity could be obtained for the latent variables corresponding to cornu ammonis-3. These results suggest that spatial cognition models incorporating neuroscience insights can contribute to improving the self-localization technology for mobile robots. The project website is https://nakashimatakeshi.github.io/HF-IGL/.

Proposal for Navigation System Using Three-Dimensional Maps—Self-Localization Using a 3D Map and Slope Detection Using a 2D Laser Range Finder and 3D Map

Many teams participating in robotic competitions achieve localization using a 2D map plotted using adaptive Monte Carlo localization, a robot operating system (ROS) open-source software program. However, outdoor environments often include nonlevel terrain such as slopes. In the indoor environment of multilevel structures, the data representing different levels overlap on the map. These factors can lead to localization failures. To resolve this problem, we develop a software by combining HDL localization, which is an ROS open-source software, with our own program, and use it to achieve localization based on a 3D map. Furthermore, the authors observe the erroneous recognition of a slope as a forward obstacle during a competition event. To resolve this, we propose a method to correct erroneous recognition of obstacles using a 2D laser range finder and 3D map and confirm its validity in an experiment carried out on a slope on a university campus.

A visual questioning answering approach to enhance robot localization in indoor environments

Navigating robots with precision in complex environments remains a significant challenge. In this article, we present an innovative approach to enhance robot localization in dynamic and intricate spaces like homes and offices. We leverage Visual Question Answering (VQA) techniques to integrate semantic insights into traditional mapping methods, formulating a novel position hypothesis generation to assist localization methods, while also addressing challenges related to mapping accuracy and localization reliability. Our methodology combines a probabilistic approach with the latest advances in Monte Carlo Localization methods and Visual Language models. The integration of our hypothesis generation mechanism results in more robust robot localization compared to existing approaches. Experimental validation demonstrates the effectiveness of our approach, surpassing state-of-the-art multi-hypothesis algorithms in both position estimation and particle quality. This highlights the potential for accurate self-localization, even in symmetric environments with large corridor spaces. Furthermore, our approach exhibits a high recovery rate from deliberate position alterations, showcasing its robustness. By merging visual sensing, semantic mapping, and advanced localization techniques, we open new horizons for robot navigation. Our work bridges the gap between visual perception, semantic understanding, and traditional mapping, enabling robots to interact with their environment through questions and enrich their map with valuable insights. The code for this project is available on GitHub https://github.com/juandpenan/topology_nav_ros2.

Application and Research on Improved Adaptive Monte Carlo Localization Algorithm for Automatic Guided Vehicle Fusion with QR Code Navigation

SLAM (simultaneous localization and mapping) technology incorporating QR code navigation has been widely used in the mobile robotics industry. However, the particle kidnapping problem, positioning accuracy, and navigation time are still urgent issues to be solved. In this paper, a SLAM fused QR code navigation method is proposed and an improved adaptive Monte Carlo positioning algorithm is used to fuse the QR code information. Firstly, the generation and resampling methods of initialized particle swarms are improved to improve the robustness and weights of the swarms and to avoid the kidnapping problem. Secondly, the Gmapping scan data and the data generated by the improved AMCL algorithm are fused using the extended Kalman filter to improve the accuracy and stability of the state estimation. Finally, in terms of the positioning system, Gmapping is used to obtain QR code data as marker positions on static maps, and the improved adaptive Monte Carlo localization particle positioning algorithm is matched with a library of QR code templates, which corrects for offset distances and achieves precise point-to-point positioning under grey-valued raster maps. The experimental results show that the particles encountered with kidnapping can be quickly adjusted in position, with a 68.73% improvement in adjustment time, 64.27% improvement in navigation and positioning accuracy, and 42.81% reduction in positioning time.

Simultaneous Localization and Mapping and Tag-Based Navigation for Unmanned Aerial Vehicles

This paper presents navigation techniques for an Unmanned Aerial Vehicle (UAV) in a virtual simulation of an indoor environment using Simultaneous Localization and Mapping (SLAM) and April Tag markers to reach a target destination. In many cases, UAVs can access locations that are inaccessible to people or regular vehicles in indoor environments, making them valuable for surveillance purposes. This study employs the Robot Operating System (ROS) to simulate SLAM techniques using LIDAR and GMapping packages for UAV navigation in two different environments. In the Tag-based simulation, the input topic for April Tag in ROS is camera images, and the calibration of position with a tag is done through assigning a message to each ID and its marker image. On the other hand, navigation in SLAM was achieved using a global and local planner algorithm. For localization, an Adaptive Monte-Carlo Localization (AMCL) technique has been used to identify factors contributing to inconsistent mapping results, such as heavy computational load, grid mapping accuracy, and inadequate UAV localization. Furthermore, this study analyzed the April Tag-based navigation algorithm, which showed satisfactory outcomes due to its lighter computing requirements. It can be ascertained that by using ROS packages, the simulation of SLAM and Tag-based UAV navigation inside a building can be achieved.

The Design and Simulation of Autonomous Agricultural Vehicle for Orchards

In recent years, agricultural producers have faced challenges due to the uncertainty of labor force access, growing demand for safe, accessible, and high-quality agricultural products, high competition with international producers, and the need to reduce their carbon footprint. To continue their competitive and profitable production, producers must invest in technology and increase efficiency. Autonomous agricultural vehicles are crucial for autonomous processes in orchards, increasing productivity, collecting data for decision-making, reducing operating costs, and carbon footprint. This study focuses on the design and simulation of an autonomous vehicle for orchards. The autonomous vehicle can map the orchards using data from odometry and light detection and ranging (LIDAR) sensors by utilizing Simultaneous Localization and Mapping (SLAM) algorithm, accurately determine its position using the Adaptive Monte Carlo Localization method, and avoid obstacles using the dynamic window approach algorithm. The autonomous vehicle is an original design for netted orchards where GPS cannot work properly and is fully autonomous, requiring no external GPS data. It is expected to provide higher efficiency by reducing environmental pollution, operating expenses, and labor force in practice. The success of the mapping and localization application depends on the update frequency of the position and the number of particles used for localization. A path-planning application was developed to reach the desired position from the autonomous agricultural vehicle's current position on the map. The Dijkstra Algorithm was used for path planning, with the Dynamic Window Approach allowing the robot to escape obstacle. The simulation studies achieved the lowest position error when the vehicle's position was updated at intervals of 2 cm, and a minimum of 500 and a maximum of 2000 particles were used. While the vehicle was moving on a straight obstacle row in the simulation environment, an average localization error of 2.1 cm was obtained. This error is convenient as it enables seamless navigation between tree rows without any collision.

Sequential Monte Carlo localization in topometric appearance maps

Representing the scene appearance by a global image descriptor (BoW, NetVLAD, etc.) is a widely adopted choice to address Visual Place Recognition (VPR). The main reasons are that appearance descriptors can be effectively provided with radiometric and perspective invariances as well as they can deal with large environments because of their compactness. However, addressing metric localization with such descriptors (a problem called Appearance-based Localization or AbL) achieves much poorer accuracy than those techniques exploiting the observation of 3D landmarks, which represent the standard for visual localization. In this paper, we propose ALLOM (Appearance-based Localization with Local Observation Models) which addresses AbL by leveraging the topological location of a robot within a map to achieve accurate metric estimations. This topology-assisted metric localization is implemented with a sequential Monte Carlo Bayesian filter that applies a specific observation model for each different place of the environment, thus taking advantage of the local correlation between the pose and the appearance descriptor within each region. ALLOM also benefits from the topological structure of the map to detect eventual robot loss-of-tracking and to effectively cope with its relocalization by applying VPR. Our proposal demonstrates superior metric localization capability compared to different state-of-the-art AbL methods under a wide range of situations.