Application of Improved Path Tracking Algorithm in Robot SLAM

doi:10.16182/j.issn1004731x.joss.22-0873

Abstract

Abstract:

Mapping is an important part of automated logistics. At present, SLAM is widely used. However, in large-scale scenes, errors are accumulated because robots often repeatedly measure and scan the region edge, which makes it impossible to quickly build a high-precision and complete map. An autonomous mapping method based on auxiliary path tracking is proposed, in which the given initial sketch is grid denoised and the auxiliary path is fitted and improved by multi segment cubic polynomial. The improved pure pursuit algorithm is used to guide the robot to build the map and improve the total distance and time of slam mapping process. Experiments in simulation and real scenes show that, compared with the existing V-SLAM and QRCode-SLAM methods, the algorithm improves the map integrity, accuracy and efficiency and provides a visual two-way interactive way for fast and efficient map construction.

Key words: SLAM, high precision complete map, denoising, auxiliary path, map construction, interaction

CLC Number:

TP242

Li Qian, Tao Ye, Li Hui. Application of Improved Path Tracking Algorithm in Robot SLAM[J]. Journal of System Simulation, 2023, 35(12): 2602-2613.

Figures/Tables 26

Fig. 1

Fig. 2

Fig. 3

Fig. 4

Fig. 5

Fig. 6

Fig. 7

Fig. 8

Fig. 9

Table 1

Fig. 10

Fig. 11

Fig. 12

Fig. 13

Fig. 14

Fig. 15

Fig. 16

Fig. 17

Table 2

Fig. 18

Table 3

Fig. 19

Fig. 20

Table 4

Fig. 21

Fig. 22

References 27

1	Yuan Zhiheng, Yang Zhengmao, Lingling Lü, et al. A Bi-level Path Planning Algorithm for Multi-AGV Routing Problem[J]. Electronics, 2020, 9(9): 1351.
2	田野, 陈宏巍, 王法胜, 等. 室内移动机器人的SLAM算法综述[J]. 计算机科学, 2021, 48(9): 223-234.
	Tian Ye, Chen Hongwei, Wang Fasheng, et al. Overview of SLAM Algorithms for Mobile Robots[J]. Computer Science, 2021, 48(9): 223-234.
3	Cadena C, Carlone L, Carrillo H, et al. Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-perception Age[J]. IEEE Transactions on Robotics, 2016, 32(6): 1309-1332.
4	Dong Jing, Ren Xingyu, Han Songlai, et al. UAV Vision Aided INS/Odometer Integration for Land Vehicle Autonomous Navigation[J]. IEEE Transactions on Vehicular Technology, 2022, 71(5): 4825-4840.
5	Feng Daquan, Wang Chunqi, He Chunlong, et al. Kalman-filter-based Integration of IMU and UWB for High-accuracy Indoor Positioning and Navigation[J]. IEEE Internet of Things Journal, 2020, 7(4): 3133-3146.
6	Rajamohan D, Kim J, Garratt M, et al. Image Based Localization Under Large Perspective Difference Between Sfm and SLAM Using Split Sim(3) Optimization[J]. Autonomous Robots, 2022, 46(3): 437-449.
7	Fang Baofu, Mei Gaofei, Yuan Xiaohui, et al. Visual SLAM for Robot Navigation in Healthcare Facility[J]. Pattern Recognition, 2021, 113: 107822.
8	李森, 范平清. 兴趣区域地图提取与ROS的多机器人SLAM地图合成研究[J]. 智能计算机与应用, 2022, 12(1): 168-171, 175.
	Li Sen, Fan Pingqing. Map Extraction of Interest Region and ROS Multi-robot SLAM Mapmerge[J]. Intelligent Computer and Applications, 2022, 12(1): 168-171, 175.
9	徐俊波, 吕宏武, 高子晗. 基于增强现实的智能交互式地图构建方法研究[J]. 自动化应用, 2020(10): 75-77, 82.
	Xu Junbo, Hongwu Lü, Gao Zihan. Research on the Construction Method of Intelligent Interactive Map Based on Augmented Reality[J]. Automation Application, 2020(10): 75-77, 82.
10	王晨捷, 罗斌, 李成源, 等. 无人机视觉SLAM协同建图与导航[J]. 测绘学报, 2020, 49(6): 767-776.
	Wang Chenjie, Luo Bin, Li Chengyuan, et al. The Collaborative Mapping and Navigation Based on Visual SLAM in UAV Platform[J]. Acta Geodaetica et Cartographica Sinica, 2020, 49(6): 767-776.
11	王桐, 尚光涛, 高山. 基于启发式的多机器人SLAM地图融合方法研究[J]. 系统仿真学报, 2022, 34(7): 1449-1458.
	Wang Tong, Shang Guangtao, Gao Shan. Research on Multi-robot SLAM Map FusionMethod Based on Heuristics[J]. Journal of System Simulation, 2022, 34(7): 1449-1458.
12	Zhao Leyang, Yan Li, Hu Xiao, et al. Efficient and High Path Quality Autonomous Exploration and Trajectory Planning of UAV in an Unknown Environment[J]. ISPRS International Journal of Geo-Information, 2021, 10(10): 631.
13	Becerra I, Yervilla-Herrera H, Antonio E, et al. On the Local Planners in the RRT* for Dynamical Systems and Their Reusability for Compound Cost Functionals[J]. IEEE Transactions on Robotics, 2022, 38(2): 887-905.
14	Liu Shuang, Li Shenghao, Pang Luchao, et al. Autonomous Exploration and Map Construction of a Mobile Robot Based on the TGHM Algorithm[J]. Sensors, 2020, 20(2): 490.
15	Yang Yang, Li Yankai, Wen Xing, et al. An Optimal Goal Point Determination Algorithm for Automatic Navigation of Agricultural Machinery: Improving the Tracking Accuracy of the Pure Pursuit Algorithm[J]. Computers and Electronics in Agriculture, 2022, 194: 106760.
16	Li Cong, Yuan Ruiman, Gao Hong, et al. Characteristics of Blue-green Laser Downlink Cross-media Transmission Under Different Weather Conditions[J]. Acta Photonica Sinica, 2021, 50(12): 1201003.
17	熊璐, 杨兴, 卓桂荣, 等. 无人驾驶车辆的运动控制发展现状综述[J]. 机械工程学报, 2020, 56(10): 127-143.
	Xiong Lu, Yang Xing, Zhuo Guirong, et al. Review on Motion Control of Autonomous Vehicles[J]. Journal of Mechanical Engineering, 2020, 56(10): 127-143.
18	Wang Lihui, Chen Zongliang, Zhu Wenxing. An Improved Pure Pursuit Path Tracking Control Method Based on Heading Error Rate[J]. Industrial Robot: The International Journal of Robotics Research and Application, 2022, 49(5): 973-980.
19	岳伟韬, 苏婧, 谷志珉, 等. 占据栅格地图的最佳栅格大小与地图精度[J]. 机器人, 2020, 42(2): 199-206.
	Yue Weitao, Su Jing, Gu Zhimin, et al. Best Grid Size of the Occupancy Grid Map and Its Accuracy[J]. Robot, 2020, 42(2): 199-206.
20	Savci K, Stove A G, Francesco De Palo, et al. Noise Radar-overview and Recent Developments[J]. IEEE Aerospace and Electronic Systems Magazine, 2020, 35(9): 8-20.
21	Du Gaoming, Wu Jiting, Cao Hongfang, et al. A Real-time Effective Fusion-based Image Defogging Architecture on FPGA[J]. ACM Transactions on Multimedia Computing, Communications, and Applications, 2021, 17(3): 93.
22	Wen Junlin, Zhu Yufan, Liu Jianbo, et al. Smartphone-based Surface Plasmon Resonance Sensing Platform for Rapid Detection of Bacteria[J]. RSC Advances, 2022, 12(21): 13045-13051.
23	Suryanarayana G, Chandran K, Khalaf O I, et al. Accurate Magnetic Resonance Image Super-resolution Using Deep Networks and Gaussian Filtering in the Stationary Wavelet Domain[J]. IEEE Access, 2021, 9: 71406-71417.
24	Wu Fangsheng, Zhu Changan, Xu Jinxiu, et al. Research on Image Text Recognition Based on Canny Edge Detection Algorithm and K-means Algorithm[J]. International Journal of System Assurance Engineering and Management, 2022, 13(1): 72-80.
25	佘丽萱, 康佳, 王楠, 等. 一种新的棉花根系图像阈值分割方法[J]. 河北大学学报(自然科学版), 2022, 42(2): 124-130.
	She Lixuan, Kang Jia, Wang Nan, et al. A New Threshold Segmentation Method for Cotton Root Images[J]. Journal of Heibei University(Natural Science Edition), 2022, 42(2): 124-130.
26	Kim J, Qi Meng, Kim M, et al. Biogas Reforming Integrated With PEM Electrolysis Via Oxygen Storage Process for Green Hydrogen Production: From Design to Robust Optimization[J]. Energy Conversion and Management, 2022, 251: 115021.
27	Uddin S, Haque I, Lu Haohui, et al. Comparative Performance Analysis of K-nearest Neighbour(KNN) Algorithm and Its Different Variants for Disease Prediction[J]. Scientific Reports, 2022, 12(1): 6256.

前瞻距离系数	最大横向误差/m	最大航向误差/rad
0.5	0.71	0.610
1.0	0.11	0.070
1.5	0.16	0.087
2.0	0.21	0.085

场景规模/m²	建图方法	用时	I/%	λ/%
10×6 (图15(a))	本文方法	37 min 25 s	100	99.82
10×6 (图15(a))	SLAM	50 min 5 s	93.65	93.21
45×22 (图16(a))	本文方法	3 h 17 min 3 s	99.82	99.05
45×22 (图16(a))	SLAM	3 h 55 min 11 s	94.09	75.45
21×22 (图17(a))	本文方法	4 h 19 min 37 s	99.33	97.70
21×22 (图17(a))	SLAM	5 h 11 min 32 s	93.70	72.41

使用方法	辅助程度	平均时间	I/%	λ/%
RRT	四边形边界	15 min 37 s	74.70	77.39
QRCode-SLAM	QRCode	11 min 49 s	83.43	79.27
V-SLAM	深度相机	9 min 32 s	70.16	63.20
V+Laser-SLAM	Laser+相机	10 min 25 s	86.96	89.32
本文方法	辅助路径	7 min 4 s	99.09	99.52

使用方法	辅助程度	平均时间	I/%	λ/%
RRT	四边形边界	11 min 32 s	67.03	59.13
QRCode-SLAM	QRCode	10 min 8 s	80.26	68.00
V-SLAM	深度相机	5 min 48 s	64.31	53.57
V+Laser-SLAM	Laser+相机	6 min 12 s	85.25	90.19
本文方法	辅助路径	4 min 15 s	98.89	97.78

[1]	Chunhong Liu, Song Wang, Fupan Wang, Wensheng Tang, Yunqiang Pei, Dongsheng Tian, Yadong Wu. AR-assisted Sign Language Letter Recognition Method Based on Improved MobileNet Network [J]. Journal of System Simulation, 2023, 35(6): 1308-1321.
[2]	Jiaxin Chen, Guohui Zhou, Jianbai Yang. Construction Technology of Hand Posture Dataset Based on Virtual Simulation Method [J]. Journal of System Simulation, 2023, 35(4): 862-870.
[3]	Zhijie Li, Shuangyu Ma, Changhua Li, Xiao Liang, Jie Zhang. Floor Evacuation Simulation Based on BIM and MR [J]. Journal of System Simulation, 2023, 35(3): 658-669.
[4]	Li Ming, Xu Qun, Wang Yan, Ji Zhicheng. Simulation and Research of Manipulator Motion Strategy Based on Adaptive Dynamic Programming [J]. Journal of System Simulation, 2023, 35(10): 2182-2192.
[5]	Wang Haoyu, Gong Guanghong, Cai Jihong, Ye Bipeng, Zhou Zhaofang, Mei Zheng, Li Ni. Dynamic 3D Scene Perception Based on Battlefield Metaverse [J]. Journal of System Simulation, 2023, 35(10): 2262-2278.
[6]	Tong Wang, Guangtao Shang, Shan Gao. Research on Multi-Robot SLAM Map FusionMethod Based on Heuristics [J]. Journal of System Simulation, 2022, 34(7): 1449-1458.
[7]	Jun Liu, Yang Gao, Tao Xu, Qing Zhao, Guihua Shan, Xuebin Chi. Interactive Construction of Scientific Workflow Based on Process Mining [J]. Journal of System Simulation, 2022, 34(7): 1547-1558.
[8]	Shijian Xu, Dan Zhao, Chengyu Su, Fupan Wang, Xiaorong Zhang, Fang Wang, Yadong Wu. Research on Immersive Virtual Reality Interactive System for Flow Visualization [J]. Journal of System Simulation, 2022, 34(5): 1160-1172.
[9]	Shiqi Lin, Jikai Wang, Haoyuan Pei, Hao Zhao, Zonghai Chen. Monocular Semantic SLAM Method Based on Object Relation Description [J]. Journal of System Simulation, 2022, 34(2): 278-284.
[10]	Yu Yanan, Shi Dunhuang, Hua Chunjie. Adaptive Optimization in Feature-based SLAM Visual Odometry [J]. Journal of System Simulation, 2022, 34(1): 104-112.
[11]	Yan Fei, Gan Bin, Chen Zhaodi, Ma Wenjuan, Li Luyao, Zhang Ke. Mechanism Design for Entities' Passive Dimensional Sensing Interaction in Discrete Event Simulations [J]. Journal of System Simulation, 2021, 33(9): 2234-2242.
[12]	Lu BaiHong, Zhao Jianjun, Liu Gesan. The Research and Implementation of Film Virtual Photography Harware-in-the-loop Simulation [J]. Journal of System Simulation, 2021, 33(8): 1938-1946.
[13]	Lin Shuo, An Lei, Gao Zhijun, Shan Dan, Shang Wenli. Research on Intrusion Detection Based on Stacked Autoencoder and Long-short Memory [J]. Journal of System Simulation, 2021, 33(6): 1288-1296.
[14]	Wu Dinghui, Zhu Zhichao, Han Xinhong. Fault Detection of Wind Turbine Bearing Based on BO-SDAE Multi-source Signal [J]. Journal of System Simulation, 2021, 33(5): 1148-1156.
[15]	Dong Shuqin, Zhang Bin. Network Traffic Anomaly Detection Method for Imbalanced Data [J]. Journal of System Simulation, 2021, 33(3): 679-689.