Hostname: page-component-77f85d65b8-t6st2 Total loading time: 0 Render date: 2026-03-29T10:01:35.640Z Has data issue: false hasContentIssue false

A multi-stage localization framework for accurate and precise docking of autonomous mobile robots (AMRs)

Published online by Cambridge University Press:  03 May 2024

Abdurrahman Yilmaz*
Affiliation:
Control and Automation Engineering Dept, Istanbul Technical University, Istanbul, Turkiye
Hakan Temeltas
Affiliation:
Control and Automation Engineering Dept, Istanbul Technical University, Istanbul, Turkiye
*
Corresponding author: Abdurrahman Yilmaz; Email: yilmazabdurrah@itu.edu.tr
Rights & Permissions [Opens in a new window]

Abstract

Autonomous navigation has been a long-standing research topic, and researchers have worked on many challenging problems in indoor and outdoor environments. One application area of navigation solutions is material handling in industrial environments. With Industry 4.0, the simple problem in traditional factories has evolved into the use of autonomous mobile robots within flexible production islands in a self-decision-making structure. Two main stages of such a navigation system are safe transportation of the vehicle from one point to another and reaching destinations at industrial standards. The main concern in the former is roughly determining the vehicle’s pose to follow the route, while the latter aims to reach the target with high accuracy and precision. Often, it may not be possible or require extra effort to satisfy requirements with a single localization method. Therefore, a multi-stage localization approach is proposed in this study. Particle filter-based large-scale localization approaches are utilized during the vehicle’s movement from one point to another, while scan-matching-based methods are used in the docking stage. The localization system enables the appropriate approach based on the vehicle’s status and task through a decision-making mechanism. The decision-making mechanism uses a similarity metric obtained through the correntropy criterion to decide when and how to switch from large-scale localization to precise localization. The feasibility and performance of the developed method are corroborated through field tests. These evaluations demonstrate that the proposed method accomplishes tasks with sub-centimeter and sub-degree accuracy and precision without affecting the operation of the navigation algorithms in real time.

Information

Type
Research Article
Creative Commons
Creative Common License - CCCreative Common License - BY
This is an Open Access article, distributed under the terms of the Creative Commons Attribution licence (http://creativecommons.org/licenses/by/4.0/), which permits unrestricted re-use, distribution and reproduction, provided the original article is properly cited.
Copyright
© The Author(s), 2024. Published by Cambridge University Press
Figure 0

Figure 1. Demonstration of the multi-stage localization framework and the need to switch between large-scale coarse and precise localization approaches.

Figure 1

Figure 2. Synthetic laser scan data generation for similarity rate definition performance tests.

Figure 2

Figure 3. Performance of overlap ratio and similarity rate approaches in estimating two laser scan sets’ relation through ten separate cases for different initial transformation states: initial transformation between two laser scan sets is (a) Zero, (b) 1% for translation and $\pm 7^\circ$ for orientation, (c) 2% for translation and $\pm 14^\circ$ for orientation, and (d) 3% for translation and $\pm 21^\circ$ for orientation. The graphs show the characteristic of similarity estimation results for each initial transformation pair.

Figure 3

Figure 4. Probabilistic switching decision mechanism between coarse and fine localization approaches based on similarity rate parameter.

Figure 4

Figure 5. Demonstration of floating boundaries over a scenario: (a) Map of the environment, (b) Four different paths followed to reach target pose, and (c) Similarity profiles of the reference and measured point sets for entire paths.

Figure 5

Figure 6. Flowchart for probabilistic switching algorithm between large-scale coarse localization and precise localization.

Figure 6

Algorithm 1 Multi-stage localization framework pseudocode

Figure 7

Figure 7. ITU-AGV: a ROS-enabled and differential-drive laboratory-type AMR unit.

Figure 8

Figure 8. ITU robotics laboratory, the field test environment: (a) The occupancy grid map of the environment, the real scene from (b) the delivery, and (c) Docking zones of the lab.

Figure 9

Figure 9. The scenarios performed for performance evaluations: (a) case 1, (b) case 2, and (c) case 3.

Figure 10

Figure 10. The overlap ratio/similarity rate estimations of trimmed ICP and correntropy for the followed trajectory of case 1: overlap ratio estimates of the trimmed ICP (a) Under the assumption that the initial pose is exactly known, (b) Using initial pose information calculated by SA-MCL, and (c) Similarity rate estimates of the correntropy with the aid of initial pose data computed by SA-MCL.

Figure 11

Figure 11. The localization performance of two-stage approach demonstrated through three cases: (a) Waypoints followed, localization by (b) SA-MCL, (c) SM, and (d) SA-MCL + SM vs GT data.

Figure 12

Figure 12. Two-stage localization approach application for case 2 - the SA-MCL is active during the delivery stage, and the SM becomes active (docking stage) when the switching point is reached, according to the similarity rate computed employing the measurements: (a) Similarity rate profile, (b) and (c) Pose estimation performance of the algorithms for x and y axes, respectively, and (d) the trajectory followed in case 2 and estimated poses by the algorithms.

Figure 13

Figure 13. The pose estimation error rates of the approaches (SA-MCL (dashed-blue), SM (solid-orange), SA-MCL + SM(dotted-yellow)): average, minimum, and maximum (a) Position and (b) Orientation estimation error rates for entire trajectories, overall (c) Position and (d) Orientation estimation error rates of reaching target pose for 100 separate offline trials.

Figure 14

Figure 14. The localization performance comparisons through three cases: (a) Cases (b) Case 1, (c) Case 2, (d) Case 3 results, and (e) Close-up view of Case 3 results around target pose.

Figure 15

Table I. Performance comparison with state-of-the-art methods in terms of fastness and computational load (PF: particle filter, SM: Scan matching, SW: Switching).

Figure 16

Table II. Performance comparison with state-of-the-art methods in terms of localization accuracy (PF: particle filter, SM: scan matching, SW: switching).

Figure 17

Figure 15. Similarity rate estimation from the current and reference laser readings, estimated current pose, and target pose.

Figure 18

Figure 16. ROS implementation of the decision mechanism, the node takes current similarity rate estimation and publishes a boolean message to decide which localization approach is active.