A Fast Method to Build Elevation Terrain Grid Map Using V-Disparity

doi:10.16183/j.cnki.jsjtu.2018.01.001

Abstract

Abstract: Automatic vehicle must perceive the off road 3D environment when it is moving on the off road. The terrain can be rebuilt by stereo vision, but it may get poor efficiency and accuracy if it is rebuilt directly. This paper uses V-disparity to preprocess the disparity image to get effective reconstruction regions and remove the non accessible area from disparity image. The inertial measurement unit (IMU) and speedometer are fused to update the elevation grid map, which is smoothed by using medium filter and areas grid filter. Thus, a 3D terrain elevation grid map can be rebuilt rapidly. The method could increase significantly the efficiency and accuracy of reconstruction since it only rebuilds the effective reconstruction region. Test results show that this method has good real-time performance and high accuracy.

Key words: automatic drive, off road terrain, elevation grid map, V-disparity, grid filter

CLC Number:

TP 242.6

YUAN Weia,b,YANG Minga,b,DENG Liuyuana,b,WANG Chunxiangc,WANG Binga,b. A Fast Method to Build Elevation Terrain Grid Map Using V-Disparity[J]. Journal of Shanghai Jiaotong University, 2018, 52(1): 1-6.

References

［1］韩光, 孙宁, 李晓飞, 等. 非结构环境理解综述［J］. 计算机应用研究, 2014, 31(8): 2248-2253. HAN Guang, SUN Ning, LI Xiaofei, et al. Unstructured scene interpretation: A review［J］. Application Research of Computers, 2014, 31(8): 2248-2253. ［2］GLVEZ A, IGLESIAS A. Particle swarm optimization for non-uniform rational B-spline surface reconstruction from clouds of 3D data points［J］. Information Sciences, 2012, 192(6): 174-192. ［3］KAZHDAN M, HUGUES H. Screened poisson surface reconstruction［J］. ACM Transactions on Graphics (TOG), 2013, 32(3): 1-13. ［4］SINGH M K, VENKATESHK S, DUTTA A. Kernel based method for surface estimation using laser scanner data［C］∥International Conference on Communications and Signal Processing (ICCSP). Melmaruvathur, India: IEEE, 2015. ［5］KO B C, JUNG J H, NAM J Y. Fire detection and 3D surface reconstruction based on stereoscopic pictures and probabilistic fuzzy logic［J］. Fire Safety Journal, 2014, 68(8): 61-70. ［6］KWEON I, KANADE T. High resolution terrain map from multiple sensor data［C］∥Proceedings of the IEEE International Workshop on Intelligent Robots and Systems (IROS’90). Washington, USA: IEEE, 1990: 127-134. ［7］BELTER D, ABECKI P, SKRZYPCZYNSKI P. Adaptive motion planning for autonomous rough terrain traversal with a walking robot［J］. Journal of Field Robotics, 2016, 33(3): 337-370. ［8］FANKHAUSER P, BLOESCH M, GEHRING C, et al. Robot-centric elevation mapping with uncertainty estimates［C］∥Climbing and Walking Robots, 2014: 433-440. ［9］SOUZA A, MAIA R S, AROCA R V, et al. Probabilistic robotic grid mapping based on occupancy and elevation information［C］∥16th International Conference on Advanced Robotics (ICAR). Montevideo, Uruguay: IEEE, 2013: 1-6. ［10］SOUZA A, GONCALVES L M G. Occupancy-elevation grid: An alternative approach for robotic mapping and navigation［J］. Robotica, 2016, 34(11): 2592-2609. ［11］FANKHAUSER P, HUTTER M. A universal grid map library: Implementation and use case for rough terrain navigation［M］∥Robot Operating System. Springer International Publishing, 2016: 99-120. ［12］BERNINI N, BERTOZZIM, CASTANGIA L, et al. Real-time obstacle detection using stereo vision for autonomous ground vehicles: A survey［C］∥17th International IEEE Conference on Intelligent Transportation Systems (ITSC). Qingdao, China: IEEE, 2014: 873-878.

[1]	WEN Yani, YAN Guozheng, WANG Zhiwu, JIANG Pingping, XUE Rongrong, WANG Yiyun. Design and Optimization of Three-Dimensional Receiving Coils for Intestinal Robots [J]. Journal of Shanghai Jiaotong University, 2020, 54(11): 1117-1123.
[2]	JING Xiaolong, HU Yuan, GUO Weizhong. High-Accuracy Calibration of Hand-Eye Matrix of Line-Structured Laser Sensor: Multiple Coordinates Transformation [J]. Journal of Shanghai Jiaotong University, 2020, 54(6): 607-614.
[3]	PU Pengxian,YAN Guozheng,WANG Zhiwu,HAN Ding. Design and Experiment of Expanding Mechanism and Power Receiving Coil for Micro Intestinal Robot [J]. Journal of Shanghai Jiaotong University, 2019, 53(10): 1143-1150.
[4]	HU Bing,YANG Ming,GUO Lindong,WANG Chunxiang,WANG Bing. Global Localization for Intelligent Vehicles Using Ground SURF [J]. Journal of Shanghai Jiaotong University, 2019, 53(2): 203-208.
[5]	SHEN Yue1,JIANG Zhihua2,YAN Guozheng1,KE Quan1,WANG Yongbing1. Optimization and Realization of Wireless Capsule Robot [J]. Journal of Shanghai Jiaotong University, 2018, 52(1): 39-44.
[6]	ZHANG Zongyu1,GAO Hongming1,HAN Qinglin1,HUANG Rui2 RONG Jian2,WANG Yongchao2. Hand-Eye Calibration in Robot Welding of Aero Tube [J]. Journal of Shanghai Jiaotong University, 2015, 49(03): 392-394.
[7]	PEI Fujun,LI Haoyang,WU Mei. Distributed Unscented Marginalized Particle Filter for Simultaneous Localization and Mapping [J]. Journal of Shanghai Jiaotong University, 2014, 48(07): 986-992.
[8]	WANG Hongjian,XU Jinlong,LIU Xiangbo,LI Juan,ZHANG Aihua. Adaptive Divided Difference Filter Algorithm Based on Support Vector Regression [J]. Journal of Shanghai Jiaotong University, 2014, 48(07): 929-935.
[9]	WANG Xudonga,WANG Chunxianga,YANG Mingb,WANG Bingb. Automatic Parking Based on Bird’s Eye View Cameras [J]. Journal of Shanghai Jiaotong University, 2013, 47(07): 1077-1081.
[10]	JIN Li-Zuan, TU Jun, LIU Cheng-Liang. A Method for Cucumber Identification Based on Iterative -RELIEF and Relevance Vector Machine [J]. Journal of Shanghai Jiaotong University, 2013, 47(04): 602-606.
[11]	HAO Chuan-Chuan-a, FANG Zhou-b, LI Ping-a. A 3-D Route Planning Algorithm for Unmanned Aerial Vehicle Based on Q-Learning [J]. Journal of Shanghai Jiaotong University, 2012, 46(12): 1931-1935.
[12]	QIU Shi-Guang-1, WU Dian-Liang-1, 2 , FAN Xiu-Min-1, 2 , HU Yong-3. Ship Ergonomics Evaluation Based on Virtual Human Real-Time Driven Modeling Technology [J]. Journal of Shanghai Jiaotong University, 2012, 46(09): 1366-1370.
[13]	LI Hao, YANG Ming. A Nonlinear Inverse Perspective Transform Based Method for Camera Distortion Calibration [J]. Journal of Shanghai Jiaotong University, 2008, 42(10): 1736-1739.
[14]	WU Shun-xi, YANG Ming . Natural Polemap Dased Localization for Intelligent Vehicles [J]. Journal of Shanghai Jiaotong University, 2008, 42(10): 1745-1748.
[15]	WANG Zhen1,XIE Le1,2,YU Wenwei3,JIANG Jun1,ZHOU Zhaozheng1. In Vivo Miniature Robot for Medical Applications [J]. Journal of Shanghai Jiaotong University, 2013, 47(12): 1881-1887.