Autonomous Localisation Method Based on Linear Feature for Robots

doi:10.16183/j.cnki.jsjtu.2018.09.017

Abstract

Abstract: The convergence for iterative closest point (ICP) algorithm depends much on the inputs, which often results in local optimum. And normal distribution transform (NDT) algorithm usually acquires more scans in scan matching, and the large angular deviation occurs during long-term autonomous navigation for robots. An improved ICP self-localization algorithm based on line feature is proposed in the paper. We derive functional relations of covariance matrix between matching scans and their fitting lines to scan and match line features rapidly. And the robot updates global poses in terms of closed form correlations. We test the reliability of CICP algorithm in indoor locating experiments. The experiments show that CICP algorithm, compared with ICP or NDT, owns higher real-time and location accuracy, and can reduce matrix computation and improve self-localization precision efficiently.

Key words: autonomous robots, global localization, iterative closest point (ICP), scan matching, filtering

CLC Number:

TP 242

YANG Jingdong,PENG Kun,GU Haonan,SHI Yanwei. Autonomous Localisation Method Based on Linear Feature for Robots[J]. Journal of Shanghai Jiao Tong University, 2018, 52(9): 1120-1124.

References

［1］CHO B S, MOON W S, SEO W J, et al. A dead reckoning localization system for mobile robots using inertial sensors and wheel revolution encoding［J］. Journal of Mechanical Science and Technology, 2011, 25 (11): 2907-2917. ［2］KNUTH J, BAROOAH P. Error growth in position estimation from noisy relative pose measurements［J］. Robotics and Autonomous Systems, 2013, 61(3): 229-244. ［3］PELIVANOV I, BUMAC T, XIA J J, et al. NDT of fiber-reinforced composites with a new fiber-optic pump-probe laser-ultrasound system［J］. Photoacoustics, 2014, 2(2): 63-74. ［4］EINHORN E, GROSS H M. Generic NDT mapping in dynamic environments and its application for lifelong SLAM［J］. Robotics and Autonomous Systems, 2015, 69: 28-39. ［5］BESL P J, MCKAY N D. A method for registration of 3-D shapes［J］. IEEE Transactions on Pattern Analysis and Machine Intelligence, 1992, 14(2): 239-256. ［6］KONECNY J, PRAUZEK M, HLAVICA J. ICP algorithm in mobile robot navigation: Analysis of computational demands in embedded solutions［J］. IFAC-Papers Online, 2016, 49(25): 396-400. ［7］PARK S, PARK S K. Global localization for mobile robots using reference scan matching［J］. International Journal of Control, Automation and Systems, 2014, 12(1): 156-168. ［8］TANG J, CHEN Y W, JAAKKOLA A. NAVIS—An UGV indoor positioning system using laser scan matching for large-area real-time applications［J］. Sensors, 2014, 14(7): 11805-11824. ［9］ARRAS K O, SIEGWART R Y. Feature extraction and scene interpretation for map-based navigation and map building［C］∥Proceedings of SPIE, Mobile Robotics XII. Pittsburgh, USA: SPIE, 1997. ［10］POMERLAEAU F, COLAS F, SIEGWART R, et al. Comparing ICP variants on real-world data sets［J］. Autonomous Robots, 2013, 34(3): 133-148. ［11］LU F. Shape registration using optimization for mobile robot navigation［D］. Toronto, Canada: Doctoral thesis at the University of Toronto, 1995. ［12］TIAR R, LAKROUF M, AZOUAOUI O. Fast ICP-SLAM for a bi-steerable mobile robot in large environments［C］∥2015 International Conference on Advanced Robotics (ICAR). Istanbul, Turkey: IEEE, 2015: 611-616.

[1]	ZHONG Yiming1, YU Caoyang1, 2, XIANG Xianbo2, 3, LIAN Lian1, 4. Motion Prediction of Marine Vehicles Based on Cascaded Filter and Error-Triggered Support Vector Regression [J]. Ocean Engineering Equipment and Technology, 2025, 12(1): 133-140.
[2]	CHEN Kun(陈坤), ZHAO Xu(赵旭), DONG Chunyu(董春玉), DI Zichao(邸子超), CHEN Zongzhi(陈宗枝). Anti-Occlusion Object Tracking Algorithm Based on Filter Prediction [J]. J Shanghai Jiaotong Univ Sci, 2024, 29(3): 400-413.
[3]	LI Shoupeng, TAO Zhenji, ZHANG Xiaoyu, XU Shihui, JIN Xiaoqin. Distributed Information Filtering-Based Cooperative Localization Method for Cluster Missiles [J]. Air & Space Defense, 2024, 7(2): 36-41.
[4]	WANG Zhelan, ZHAO Hongjie, ZHAO Fan, SHEN Chenchen, WU Jiawei. Establishment of Remaining Life Prediction Model for an Inertial Navigation System Based on Convolutional Neural Network and Filtering Fusion Algorithm [J]. Air & Space Defense, 2023, 6(1): 70-77.
[5]	XIONG Yuefu (熊越夫), WU Xiaosheng∗ (吴校生), ZENG Zhaofeng (曾照丰), HUANG Shan (黄山), CHEN Tianpei (陈天培). High Precision Temperature Measurement for Microfluidic Chip Applications [J]. J Shanghai Jiaotong Univ Sci, 2022, 27(5): 699-705.
[6]	HUANG Yinghao1,2 (黄颖浩), WU Yi3 (吴怡), YAO Lixiu2 (姚莉秀), CAI Yunze1,2∗ (蔡云泽). A Class of Distributed Variable Structure Multiple Model Algorithm Based on Posterior Information of Information Matrix [J]. J Shanghai Jiaotong Univ Sci, 2022, 27(5): 671-679.
[7]	ZHAO Yong, SU Dan. Rogue Wave Prediction Based on Four Combined Long Short-Term Memory Neural Network Models [J]. Journal of Shanghai Jiao Tong University, 2022, 56(4): 516-522.
[8]	ZHANG Wenjia, MA Xin. A Sliding Window Adaptive Filtering Algorithm for Autonomous Navigation of the Approach Phase of Deep Space Probe [J]. Journal of Shanghai Jiao Tong University, 2022, 56(11): 1461-1469.
[9]	LE Jian, LIU Yichun, ZHANG Hua, CHEN Xiaoqi. A Detection Method of Wire Feeding Speed Based on Filtering Algorithm of Distortion Signal [J]. Journal of Shanghai Jiao Tong University, 2022, 56(10): 1334-1340.
[10]	YANG Qingyu, SONG Quanhong, WEI Zhifei, GU Yifan. Infrared and Visible Light Image Fusion Based on Guided Filtering Weight and Saliency Information Optimization [J]. Air & Space Defense, 2021, 4(4): 113-118.
[11]	ZHANG Lulu (章露露), DONG Xiangxiang (董祥祥), YAO Lixiu (姚莉秀), CAI Yunze (蔡云泽). Velocity-Varying Target Tracking of Mobile Sensor Network Based on Flocking Control [J]. J Shanghai Jiaotong Univ Sci, 2021, 26(4): 446-453.
[12]	LIU Xiaoyang, XU Weili, CHEN Jiming, XU Peiran, ZHOU Xiangxiang. A Self-Adaptive Modified Angle Filtering Algorithm Based on Passive Tracking Environment [J]. Air & Space Defense, 2021, 4(2): 48-53.
[13]	CUI Naigang , CAI Ligen, RONG Siyuan. High-speed Gliding Target Tracking Algorithm Based on Digraph Switching IMM-CKF [J]. Air & Space Defense, 2020, 3(3): 1-8.
[14]	ZHANG Shuai, DING Liping, WANG Zhide, TANG Xiaofeng, FAN Wenjing. Research on Reliability of Power on Reset of CSD Serial Board in Launch Control Equipment [J]. Air & Space Defense, 2020, 3(2): 29-36.
[15]	ZHANG Sipei, LIU Hongming, YU Ke, LUO Chen, YU Wen. A Robust Filtering Algorithm for Radar Target Tracking [J]. Air & Space Defense, 2020, 3(1): 73-79.