The localization problem in robotics has been widely studied both for indoor and outdoor applications, but is still open for improvements. In indoor environments, GPS-based methods are not preferred due to reflections, and the pose of the robot is determined according to the measurements taken around with its sensors. One of them is iterative closest point (ICP)-based localization method. ICP is a point set registration method, the essence of which is to iteratively compute the transformation between two point sets. However, it is also utilized to solve the localization problem thanks to its high precision in registration. Precise localization is important for applications that require highly accurate pose estimation, such as for smart-AGVs to be used in smart factories to reach a station at industrial standards. Traditional ICP finds transformation in terms of a rotation and translation, and thus can be directly applied to the localization problem. On the other hand, the affine variant of ICP is not adapted to solve the localization problem. In this study, the necessary arrangements to make affine ICP suitable for precise localization are given as a procedure such that the transformation between point sets is found by affine ICP, the resulting transformation is projected to rotation plane by polar decomposition and then the pose is estimated. The enhancements achieved with the usage of affine ICP in precise localization problems are demonstrated in simulation by comparing localization performance of affine ICP with that of traditional ICP. For this purpose, in a factory environment, a scenario where a smart-AGV approaching the target autonomously to carry out an operation has been prepared. The performances of the algorithms have been evaluated for five different docking stations with 30 separate experiments. Moreover, the challenges related to the affine ICP-based fine localization, in particular about finding projection of affine transformation to rotation plane, are highlighted in this study.
AghiliFSuCY (2016) Robust relative navigation by integration of icp and adaptive kalman filter using laser scanner and IMU. IEEE/ASME Transactions on Mechatronics21(4): 2015–2026. DOI:10.1109/TMECH.2016.2547905.
2.
AxlerSJ (2015) Linear Algebra Done Right2. Cham: Springer. DOI: 10.1007/978-3-319-11080-6.
3.
BalcılarMYavuzSAmasyalıMFUsluEÇakmakF (2017) R-slam: Resilient localization and mapping in challenging environments. Robotics and Autonomous Systems87: 66–80. DOI:10.1016/j.robot.2016.09.013.
4.
BarberCBDobkinDPHuhdanpaaH (1996) The quickhull algorithm for convex hulls. ACM Transactions on Mathematical Software22(4): 469–483.
5.
BeslPJMcKayND, et al. (1992) A method for registration of 3-d shapes. IEEE Transactions on Pattern Analysis and Machine Intelligence14(2): 239–256.
6.
BuckSHantenRBohlmannKZellA (2017) Multi-sensor payload detection and acquisition for truck-trailer AGVs. In: 2017 IEEE International Conference on Robotics and Automation (ICRA). IEEE, pp. 718–723. DOI:10.1109/ICRA.2017.7989088.
7.
ChenHZhangXDuSWuZZhengN (2019) A correntropy-based affine iterative closest point algorithm for robust point set registration. IEEE/CAA Journal of Automatica Sinica6(4): 981–991.
8.
DellaertFFoxDBurgardWThrunS (1999) Monte Carlo localization for mobile robots. In: IEEE International Conference on Robotics and Automation, Volume 2. IEEE, pp. 1322–1328.
9.
DuSXuGZhangSZhangXGaoYChenB (2020) Robust rigid registration algorithm based on pointwise correspondence and correntropy. Pattern Recognition Letters132: 91–98.
10.
DuSZhengNYingSLiuJ (2010) Affine iterative closest point algorithm for point set registration. Pattern Recognition Letters31(9): 791–799.
11.
DuymazEOğuzAETemeltaşH (2017) Eş zamanl konum belirleme ve haritalama probleminde yeni bir durum tahmin yöntemi olarak parçack akş filtresi. Gazi Üniversitesi Mühendislik-Mimarlk Fakültesi Dergisi32(4): 1255–1270. DOI:10.17341/gazimmfd.369697.
12.
EvansPCAnnunziataM (2012) Industrial Internet: Pushing the boundaries of minds and machines. General Electric Reports, pp. 1–37.
13.
ForbesJR (2013) Adaptive approaches to nonlinear state estimation for mobile robot localization: An experimental comparison. Transactions of the Institute of Measurement and Control35(8): 971–985.
14.
FoxD (2002) KLD-sampling: Adaptive particle filters. In: DietterichTGBeckerSGhahramaniZ (eds.) Advances in Neural Information Processing Systems 14. MIT Press, 713–720.
15.
GoldsteinH (1980) Classical Mechanics. Pearson Education India.
16.
GomezOSalehiAGay-BellileVCarrierM (2017) Accurate indoor localization through constrained visual slam. In: 2017 International Conference on Indoor Positioning and Indoor Navigation (IPIN)Sapporo, Japan, 18–21 September 2017, pp. 1–4.
17.
GreenspanMYurickM (2003) Approximate KD tree search for efficient ICP. In: Fourth International Conference on 3-D Digital Imaging and Modeling, 2003. 3DIM 2003. Proceedings. IEEE, pp. 442–448.
18.
GrisettiGStachnissCBurgardW (2007) Improved techniques for grid mapping with RAO-Blackwellized particle filters. IEEE Transactions on Robotics23(1): 34–46. DOI:10.1109/TRO.2006.889486.
19.
HighamNJ (1986) Computing the polar decomposition with applications. SIAM Journal on Scientific and Statistical Computing7(4): 1160–1174.
20.
HsuCCYehSSHsuPL (2016) Particle filter design for mobile robot localization based on received signal strength indicator. Transactions of the Institute of Measurement and Control38(11): 1311–1319.
21.
JainSArgallB (2014) Automated perception of safe docking locations with alignment information for assistive wheelchairs. In: 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems. IEEE, pp. 4997–5002. DOI:10.1109/IROS.2014.6943272.
22.
JettoLLonghiSVenturiniG (1999) Development and experimental validation of an adaptive extended Kalman filter for the localization of mobile robots. IEEE Transactions on Robotics and Automation15(2): 219–229.
23.
KimHLiuBGohCYLeeSMyungH (2017) Robust vehicle localization using entropy-weighted particle filter-based data fusion of vertical and road intensity information for a large scale urban area. IEEE Robotics and Automation Letters2(3): 1518–1524. DOI:10.1109/LRA.2017.2673868.
24.
KohlbrecherSVon StrykOMeyerJKlingaufU (2011) A flexible and scalable slam system with full 3D motion estimation. In: Safety, Security, and Rescue Robotics (SSRR), 2011 IEEE International Symposium. IEEE, pp. 155–160. DOI:10.1109/SSRR.2011.6106777 .
25.
KotaruMJoshiKBharadiaDKattiS (2015) Spotfi: Decimeter level localization using wifi. In: ACM SIGCOMM Computer Communication Review, Volume 45. ACM, pp. 269–282. DOI:10.1145/2785956.2787487.
26.
KumarSGilSKatabiDRusD (2014) Accurate indoor localization with zero start-up cost. In: Proceedings of the 20th Annual International Conference on Mobile Computing and Networking. ACM, pp. 483–494. DOI:10.1145/2639108.2639142.
27.
LasiHFettkePKemperHGFeldTHoffmannM (2014) Industry 4.0. Business & Information Systems Engineering6(4): 239–242.
28.
LiAWBastosGS (2017) A hybrid self-adaptive particle filter through KLD-sampling and SAMCL. In: Advanced Robotics (ICAR), 2017 18th International Conference on. IEEE, pp. 106–111.
29.
LiSLeeD (2016) Fast visual odometry using intensity-assisted iterative closest point. IEEE Robotics and Automation Letters1(2): 992–999. DOI:10.1109/LRA.2016.2530164.
30.
LuoJQinS (2018) A fast algorithm of simultaneous localization and mapping for mobile robot based on ball particle filter. IEEE Access6: 20412–20429. DOI:10.1109/ACCESS.2018.2819419.
31.
NobiliSSconaRCaravagnaMFallonM (2017) Overlap-based ICP tuning for robust localization of a humanoid robot. In: 2017 IEEE International Conference on Robotics and Automation (ICRA). IEEE, pp. 4721–4728. DOI:10.1109/ICRA.2017.7989547.
32.
RöwekämperJSprunkCTipaldiGDStachnissCPfaffPBurgardW (2012) On the position accuracy of mobile robot localization based on particle filters combined with scan matching. In: 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems. IEEE, pp. 3158–3164. DOI:10.1109/IROS.2012.6385988.
33.
RöwekämperJSugerBBurgardWTipaldiGD (2015) Accurate localization with respect to moving objects via multiple-body registration. In: 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, pp. 3741–3746. DOI:10.1109/IROS.2015.7353901.
34.
SegalAHaehnelDThrunS (2009) Generalized-ICP. In: Proceedings of Robotics: Science and Systems, Seattle, USA, 28 June–1 July 2009, pp. 1–8.
35.
ServosJWaslanderSL (2017) Multi-channel generalized-ICP: A robust framework for multi-channel scan registration. Robotics and Autonomous Systems87: 247–257. DOI:10.1016/j.robot.2016.10.016.
36.
VasiljevićGMiklićDDraganjacIKovačićZListaP (2016) High-accuracy vehicle localization for autonomous warehousing. Robotics and Computer-Integrated Manufacturing42: 1–16.
37.
VasishtDKumarSKatabiD (2016) Decimeter-level localization with a single wifi access point. In: 13th {USENIX} Symposium on Networked Systems Design and Implementation (NSDI 16), pp. 165–178.
38.
WangJWangPChenZ (2018) A novel qualitative motion model based probabilistic indoor global localization method. Information Sciences429: 284–295.
39.
WangXZhangCLiuFDongYXuX (2017) Exponentially weighted particle filter for simultaneous localization and mapping based on magnetic field measurements. IEEE Transactions on Instrumentation and Measurement66(7): 1658–1667. DOI:10.1109/TIM.2017.2664538.
40.
WuZChenHDuS (2016) Robust affine iterative closest point algorithm based on correntropy for 2D point set registration. In: 2016 International Joint Conference on Neural Networks (IJCNN). IEEE, pp. 1415–1419.
41.
XiongJJamiesonK (2013) Arraytrack: A fine-grained indoor location system. In: 10th USENIX Symposium on Networked Systems Design and Implementation (NSDI 13), pp. 71–84.
42.
YilmazATemeltasH (2019) Self-adaptive Monte Carlo method for indoor localization of smart AGVs using LIDAR data. Robotics and Autonomous Systems122: 103285.
43.
ZhangLFinkelsteinARusinkiewiczS (2019a) High-precision localization using ground texture. In: 2019 International Conference on Robotics and Automation (ICRA). IEEE, pp. 6381–6387.
44.
ZhangLZapataRLepinayP (2012) Self-adaptive Monte Carlo localization for mobile robots using range finders. Robotica30(2): 229–244.
45.
ZhangQBWangPChenZH (2019b) An improved particle filter for mobile robot localization based on particle swarm optimization. Expert Systems with Applications135: 181–193.
