吉林大学学报(工学版) ›› 2013, Vol. 43 ›› Issue (04): 1035-1044.doi: 10.7964/jdxbgxb201304031

• paper • Previous Articles     Next Articles

Rescue robot simultaneous localization and mapping based on extraction and matching of line features

LIU Shao-gang1, GUO Yun-long1, JIA He-ming2   

  1. 1. College of Mechanical and Electrical Engineering, Harbin Engineering University, Harbin 150001, China;
    2. College of Mechanical and Electrical Engineering, Northeast Forestry University, Harbin 150040, China
  • Received:2012-05-07 Online:2013-07-01 Published:2013-07-01

Abstract:

To solve the problem of simultaneous localization and mapping by rescue robot in line feature post-disaster environment, an improved dynamic threshold algorithm is proposed based on the split-and-merge principle. Compared with the fixed threshold method, the proposed method improves the accuracy of straight line fitting. The parameters of matching conditions and state matrix are deduced. Mismatching problem can be solved by calculating and comparing the distance between initial point and end point, thus improving the accuracy of line feature matching. On this basis, global location calculation is carried out and least square filter is employed to improve accuracy of location. The simulation and experiment demonstrate that the proposed method has high accuracy to reflect the actual terrain environment and the ability of real-time mapping.

Key words: automatic control technology, search and rescue after disaster, robot, simultaneous localization and mapping, feature extraction, feature line matching

CLC Number: 

  • TP24

[1] 蔡自兴. 动态环境中移动机器人地图构建的研究进展[J]. 控制工程, 2007,14(3): 1-6. Cai Zi-xing. Advances on map building with mobile robots in dynamic environments[J]. Control Engineering of China, 2007, 14(3): 1-6.

[2] Birk A, Matsuno Fumitoshi. Editorial: safety, security, and rescue robotics special issue[J]. Journal of Field Robotics, 2011, 28(6): 813-816.

[3] Kwon H J, Shim H, Kim D, et al. A development of a transformable caterpillar equipped mobile robot//International Conference on Control, Seoul, Korea, Automation and Systems, 2007: 1062-1065.

[4] 刘罡, 刘玉斌, 赵杰, 等. 基于可视切线图的新型煤矿救援机器人路径规划[J]. 吉林大学学报:工学版, 2011, 41(4): 1107-1112. Liu Gang, Liu Yu-bin, Zhao Jie, et al. Path planning for a new mine rescue robot base on visual tangent graphs[J]. Journal of Jilin University(Engineering and Technology Edition), 2011, 41(4): 1107-1112.

[5] 刘金国,王越超,李斌,等.灾难救援机器人研究现状、关键性能及展望[J]. 机械工程学报,2006,42(12):1-12. Liu Jin-guo, Wang Yue-chao, Li Bin, et al. Current research, key performances and future development of search and rescue robot[J]. Chinese Journal of Mechanical Engineering, 2006, 42(12): 1-12.

[6] Leonard J J,Durrant-Whyte H F.Mobile robot localization by tracking geometric beacons[J].IEEE Transactions on Robotics and Automation,1991,7(3):376-382.

[7] Durrant-Whyte H F, Bailey T. Simultaneous localization and mapping part I[J]. IEEE Robotics and Automation Magazine, 2006, 13(2): 99-110.

[8] Ramkumar K, Manigandan N S. Stochastic filters for mobile robot slam problems—a review[J]. Sensors and Transducers, 2012, 138(3): 141-149.

[9] Bonnabel Silvère. Symmetries in observer design: Review of some recent results and applications to EKF-based SLAM[J]. Lecture Notes in Control and Information Sciences, 2012, 422: 3-15.

[10] 贾鹤鸣,宋文龙,陈子印.基于反馈增益反步法的非完整约束移动机器人路径跟踪控制[J].吉林大学学报:工学版,2012,42(4):1003-1007. Jia He-ming,Song Wen-long,Chen Zi-yin.Path-following controller for non-holonomic mobile robots based on feedback gain backstepping[J].Journal of Jilin University(Engineering and Technology Edition),2012,42(4):1003-1007.

[11] Smith R, Cheesman P. On the representation and estimation of spatial uncertainty[J]. The International Journal of Robotics Research, 1987, 5(4): 56-68.

[12] Zeng Wen-jing, Wan Lei, Zhang Tie-dong, et al. Simultaneous localization and mapping of autonomous underwater vehicle using looking forward sonar[J]. Journal of Shanghai Jiaotong University(Science Edition), 2012, 17(1): 91-97.

[13] Montemerlo M, Thrun S. Simultaneous localization and mapping with unknown data association using FastSLAM//Proc IEEE Int Conf Robotics and Automation,Taipei: IEEE Press, 2003.

[14] 厉茂海, 洪炳熔, 罗荣华. 用Rao_Blackwellized粒子滤波器实现移动机器人同时定位和地图创建[J]. 吉林大学学报:工学版, 2007, 37(2): 401-406. Li Mao-hai, Hong Bing-rong, Luo Rong-hua. Improved Rao-Blackwellized particle filters for mobile robot simultaneous localization and mapping[J]. Journal of Jilin University(Engineering and Technology Edition), 2007, 37(2): 401-406.

[15] Nieto J,Bailey T,Nebot E. Recursive scan-matching SLAM[J].Robotics and Autonomous Systems,2007,55(1):39-49.

[16] 孙作雷, 茅旭初. 基于激光束匹配和图模型的移动机器人相对运动估计误差分析[J]. 自动化学报, 2011, 37(2): 205-213. Sun Zuo-lei, Mao Xu-chu. Quantification of relative movement uncertainty based on laser scan matching and graphical model for mobile robot[J]. Acta Automatica Sinica, 2011, 37(2): 205-213.

[17] 刘少刚,郭云龙. 主臂可变构型式越障机构. 中国: 201110174696.6, 2011-11-23.

[18] 王卫华,陈卫东,席裕庚.移动机器人地图创建中的不确定传感信息处理[J].自动化学报,2003,29(2):267-274. Wang Wei-hua,Chen Wei-dong,Xi Yu-geng.Uncertainty sensor information processing in map building of mobile robot[J].Acta Automatica Sinica,2003,29(2):267-274.

[19] 曹红玉, 孙汉旭, 贾庆轩, 等. 基于改进的D-S证据理论的栅格地图构建[J]. 吉林大学学报:工学版, 2011, 41(4): 1126-1130. Cao Hong-yu, Sun Han-xu, Jia Qing-xuan, et al. Building grid map with improved Dempster-Shafer evidence theory[J]. Journal of Jilin University(Engineering and Technology Edition), 2011, 41(4): 1126-1130.

[20] Cyrill S, Udo F, Giorgro G. Mapping and grid SLAM code. http://www.openslam.org, 2008.

[1] GU Wan-li,WANG Ping,HU Yun-feng,CAI Shuo,CHEN Hong. Nonlinear controller design of wheeled mobile robot with H performance [J]. Journal of Jilin University(Engineering and Technology Edition), 2018, 48(6): 1811-1819.
[2] LI Zhan-dong,TAO Jian-guo,LUO Yang,SUN Hao,DING Liang,DENG Zong-quan. Design of thrust attachment underwater robot system in nuclear power station pool [J]. Journal of Jilin University(Engineering and Technology Edition), 2018, 48(6): 1820-1826.
[3] WANG De-jun, WEI Wei-li, BAO Ya-xin. Actuator fault diagnosis of ESC system considering crosswind interference [J]. Journal of Jilin University(Engineering and Technology Edition), 2018, 48(5): 1548-1555.
[4] YAN Dong-mei, ZHONG Hui, REN Li-li, WANG Ruo-lin, LI Hong-mei. Stability analysis of linear systems with interval time-varying delay [J]. Journal of Jilin University(Engineering and Technology Edition), 2018, 48(5): 1556-1562.
[5] TIAN Yan-tao, ZHANG Yu, WANG Xiao-yu, CHEN Hua. Estimation of side-slip angle of electric vehicle based on square-root unscented Kalman filter algorithm [J]. 吉林大学学报(工学版), 2018, 48(3): 845-852.
[6] ZHANG Shi-tao, ZHANG Bao, LI Xian-tao, WANG Zheng-xi, TIAN Da-peng. Enhancing performance of FSM based on zero phase error tracking control [J]. 吉林大学学报(工学版), 2018, 48(3): 853-858.
[7] GENG Qing-tian, YU Fan-hua, WANG Yu-ting, GAO Qi-kun. New algorithm for vehicle type detection based on feature fusion [J]. 吉林大学学报(工学版), 2018, 48(3): 929-935.
[8] WANG Lin, WANG Hong-guang, SONG Yi-feng, PAN Xin-an, ZHANG Hong-zhi. Behavior planning of a suspension insulator cleaning robot for power transmission lines [J]. 吉林大学学报(工学版), 2018, 48(2): 518-525.
[9] HU Yun-feng, WANG Chang-yong, YU Shu-you, SUN Peng-yuan, CHEN Hong. Structure parameters optimization of common rail system for gasoline direct injection engine [J]. 吉林大学学报(工学版), 2018, 48(1): 236-244.
[10] ZHU Feng, ZHANG Bao, LI Xian-tao, WANG Zheng-xi, ZHANG Shi-tao. Gyro signal processing based on strong tracking Kalman filter [J]. 吉林大学学报(工学版), 2017, 47(6): 1868-1875.
[11] JIN Chao-qiong, ZHANG Bao, LI Xian-tao, SHEN Shuai, ZHU Feng. Friction compensation strategy of photoelectric stabilized platform based on disturbance observer [J]. 吉林大学学报(工学版), 2017, 47(6): 1876-1885.
[12] XIE Zhi-jiang, WU Xiao-yong, FAN Nai-ji, GUO Zong-huan, YUAN Yue-jun, WANG Kang. Kinematics analysis of a precision assembly platform of SG-III [J]. 吉林大学学报(工学版), 2017, 47(5): 1504-1511.
[13] FENG Jian-xin. Recursive robust filtering for uncertain systems with delayed measurements [J]. 吉林大学学报(工学版), 2017, 47(5): 1561-1567.
[14] DONG Qiang, LIU Jing-hong, ZHOU Qian-fei. Improved SURF algorithm used in image mosaic [J]. 吉林大学学报(工学版), 2017, 47(5): 1644-1652.
[15] XU Jin-kai, WANG Yu-tian, ZHANG Shi-zhong. Dynamic characteristics of a heavy duty parallel mechanism with actuation redundancy [J]. 吉林大学学报(工学版), 2017, 47(4): 1138-1143.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
[1] XIAO Yun, LEI Jun-qing, ZHANG Kun, LI Zhong-san. Fatigue stiffness degradation of prestressed concrete beam under multilevel amplitude cycle loading[J]. 吉林大学学报(工学版), 2013, 43(03): 665 -670 .
[2] ZHOU Feng-dao, TANG Hong-zhong, GUO Xin, WANG Jin-yu. Current overshoot produce principle and inhibition of transmitter of time domain electromagnetic detection system[J]. 吉林大学学报(工学版), 2013, 43(04): 1023 -1028 .
[3] LI Zhan-shan, ZHANG Liang, GUO Jin-song, ZHANG Qian. Boundary heuristic based on problem structure[J]. 吉林大学学报(工学版), 2013, 43(04): 1045 -1051 .
[4] SANG Ai-jun, MU Sen, WANG Mo-lin, CUI Hai-ting, CHEN He-xin. Multi-view video coding based on multi-dimensional vector matrix[J]. 吉林大学学报(工学版), 2013, 43(04): 1110 -1115 .
[5] TONG Jin, WANG Ya-hui, FAN Xue-mei, ZHANG Shu-jun, CHEN Dong-hui. Monitoring system of cold chain logistics for farm fresh produce[J]. 吉林大学学报(工学版), 2013, 43(06): 1707 -1711 .
[6] LIN Jun,FU Lei,WANG Yan-zhang,XU Jiang,JI Yan-ju,YANG Meng-meng. Development of sensor used for grounded electrical source air-ground transient electromagnetic detection[J]. 吉林大学学报(工学版), 2014, 44(3): 888 -894 .
[7] GAO Zhen-hai, LI Yang, ZHANG Hui, ZHANG Li-dan, HU Hong-yu. Driver's forward-looking behavior analysis during lane change under different speed[J]. 吉林大学学报(工学版), 2016, 46(5): 1385 -1390 .
[8] SU Chang, FU Li-ming, WEI Jun, LI Shuo, HUANG Lei, CAO Yue. Design method in exterior color based Kansei engineering and principal component analysis[J]. 吉林大学学报(工学版), 2016, 46(5): 1414 -1419 .
[9] LANG Li-hui, WANG Yao, LI Kui, SUN Zhi-ying, ZHANG Quan-da. Factors influencing inverse bulging effect in sheet hydroforming[J]. 吉林大学学报(工学版), 2016, 46(5): 1567 -1576 .
[10] TIAN Yan-tao, WANG Xiao-yu, HU Lei-lei, LIAN Yu-feng, ZHAO Yun, YIN Cheng. Active collision avoidance algorithm in electric vehicle lateral lane change[J]. 吉林大学学报(工学版), 2016, 46(5): 1587 -1594 .