Obstacle Classification and 3D Measurement in Unstructured Environments Based on ToF Cameras

Inspired by the human 3D visual perception system, we present an obstacle detection and classification method based on the use of Time-of-Flight (ToF) cameras for robotic navigation in unstructured environments. The ToF camera provides 3D sensing by capturing an image along with per-pixel 3D space information. Based on this valuable feature and human knowledge of navigation, the proposed method first removes irrelevant regions which do not affect robot's movement from the scene. In the second step, regions of interest are detected and clustered as possible obstacles using both 3D information and intensity image obtained by the ToF camera. Consequently, a multiple relevance vector machine (RVM) classifier is designed to classify obstacles into four possible classes based on the terrain traversability and geometrical features of the obstacles. Finally, experimental results in various unstructured environments are presented to verify the robustness and performance of the proposed approach. We have found that, compared with the existing obstacle recognition methods, the new approach is more accurate and efficient.

[1]  Andreas Birk,et al.  Efficient Representation in Three-Dimensional Environment Modeling for Planetary Robotic Exploration , 2010, Adv. Robotics.

[2]  R Madhavan,et al.  Obstacle Detection using a TOF Range Camera for Indoor AGV Navigation , 2004 .

[3]  Roberto Manduchi,et al.  Fast and reliable obstacle detection and segmentation for cross-country navigation , 2002, Intelligent Vehicle Symposium, 2002. IEEE.

[4]  Andreas Birk,et al.  Fast Registration Based on Noisy Planes With Unknown Correspondences for 3-D Mapping , 2010, IEEE Transactions on Robotics.

[5]  Jaime Valls Miró,et al.  Information-Efficient 3-D Visual SLAM for Unstructured Domains , 2008, IEEE Transactions on Robotics.

[6]  Sven Wachsmuth,et al.  Laser-based navigation enhanced with 3D time-of-flight data , 2009, 2009 IEEE International Conference on Robotics and Automation.

[7]  Clayton Kunz,et al.  Photo-realistic Terrain Modeling and Visualization for Mars Exploration Rover Science Operations , 2005, 2005 IEEE International Conference on Systems, Man and Cybernetics.

[8]  Takeo Kanade,et al.  High-Resolution Terrain Map from Multiple Sensor Data , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[9]  R. Castano,et al.  Current results from a rover science data analysis system , 2005, 2005 IEEE Aerospace Conference.

[10]  Yoji Kuroda,et al.  Vision-Based Probabilistic Map Estimation with an Inclined Surface Grid for Rough Terrain Rover Navigation , 2010, Adv. Robotics.

[11]  Andreas Birk,et al.  Efficient Representation in 3D Environment Modeling for Planetary Robotic Exploration , 2010 .

[12]  Klaus-Dieter Kuhnert,et al.  Fusion of Stereo-Camera and PMD-Camera Data for Real-Time Suited Precise 3D Environment Reconstruction , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Reinhard Koch,et al.  Time-of-Flight sensor calibration for accurate range sensing , 2010, Comput. Vis. Image Underst..

[14]  Jens M. Turowski,et al.  Measuring streambed morphology using range imaging , 2010 .

[15]  C. H. Schaefer,et al.  Range imaging for autonomous navigation of robotic land vehicles , 1991, Signal Process..

[16]  Joachim Hertzberg,et al.  6D SLAM—3D mapping outdoor environments , 2007, J. Field Robotics.

[17]  Dieter Fox,et al.  RGB-D Mapping: Using Depth Cameras for Dense 3D Modeling of Indoor Environments , 2010, ISER.

[18]  Sanjiv Singh,et al.  Obstacle detection using adaptive color segmentation and color stereo homography , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[19]  Joachim Hertzberg,et al.  An autonomous mobile robot with a 3D laser range finder for 3D exploration and digitalization of indoor environments , 2003, Robotics Auton. Syst..

[20]  Zhengyou Zhang,et al.  Low-complexity, near-lossless coding of depth maps from kinect-like depth cameras , 2011, 2011 IEEE 13th International Workshop on Multimedia Signal Processing.

[21]  Ben Taskar,et al.  Online, self-supervised terrain classification via discriminatively trained submodular Markov random fields , 2008, 2008 IEEE International Conference on Robotics and Automation.

[22]  Andreas Donaubauer,et al.  Real-time indoor positioning using range imaging sensors , 2010, Photonics Europe.

[23]  Yaonan Wang,et al.  Registration and fusion for ToF camera and 2D camera reading , 2013, 2013 Chinese Automation Congress.

[24]  Tobias K. Kohoutek Analysis and processing the 3d‐range‐image‐data for robot monitoring , 2008 .

[25]  Roland Siegwart,et al.  A state-of-the-art 3D sensor for robot navigation , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[26]  Andreas Birk,et al.  Hough based terrain classification for realtime detection of drivable ground , 2008, J. Field Robotics.

[27]  Rasmus Larsen,et al.  TOF imaging in Smart room environments towards improved people tracking , 2008, 2008 IEEE Computer Society Conference on Computer Vision and Pattern Recognition Workshops.

[28]  Robert C. Bolles,et al.  Mapping, navigation, and learning for off‐road traversal , 2009, J. Field Robotics.

[29]  Andreas Kolb,et al.  Compensation of Motion Artifacts for Time-of-Flight Cameras , 2009, Dyn3D.

[30]  Martial Hebert,et al.  Natural terrain classification using three‐dimensional ladar data for ground robot mobility , 2006, J. Field Robotics.

[31]  Larry H. Matthies,et al.  Two years of Visual Odometry on the Mars Exploration Rovers , 2007, J. Field Robotics.

[32]  Larry H. Matthies,et al.  Terrain Adaptive Navigation for planetary rovers , 2009, J. Field Robotics.

[33]  Rasmus Larsen,et al.  Fusion of stereo vision and Time-Of-Flight imaging for improved 3D estimation , 2008, Int. J. Intell. Syst. Technol. Appl..

[34]  Y. Kunii,et al.  Shadow casting stereo imaging for high accurate and robust stereo processing of natural environment , 2008, 2008 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[35]  Larry Matthies,et al.  Stereo vision and rover navigation software for planetary exploration , 2002, Proceedings, IEEE Aerospace Conference.

[36]  Anthony Stentz,et al.  Online adaptive rough-terrain navigation vegetation , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[37]  S. E. Ghobadi,et al.  First steps in enhancing 3D vision technique using 2D/3D sensors , 2006 .

[38]  Robert Mahony,et al.  Statistical analysis of signal measurement in time-of-flight cameras , 2011 .

[39]  José Barata,et al.  Stereo-based all-terrain obstacle detection using visual saliency , 2011, J. Field Robotics.

[40]  Jong-Eun Ha,et al.  A detection cell using multiple points of a rotating triangle to find local planar regions from stereo depth data , 2009, Pattern Recognit. Lett..

[41]  Gregory Z. Grudic,et al.  Learning terrain segmentation with classifier ensembles for autonomous robot navigation in unstructured environments , 2009, J. Field Robotics.

[42]  Heinz Hügli,et al.  Computing visual attention from scene depth , 2000, Proceedings 15th International Conference on Pattern Recognition. ICPR-2000.

[43]  Ken Nakayama,et al.  Serial and parallel processing of visual feature conjunctions , 1986, Nature.

[44]  Bernd Jähne,et al.  A theoretical and experimental investigation of the systematic errors and statistical uncertainties of Time-Of-Flight-cameras , 2008, Int. J. Intell. Syst. Technol. Appl..

[45]  Antonio Fernández-Caballero,et al.  Mobile robot map building from time-of-flight camera , 2012, Expert Syst. Appl..

[46]  Carme Torras,et al.  Exploitation of time-of-flight (ToF) cameras , 2010 .

[47]  Frédo Durand,et al.  Bilateral Filtering: Theory and Applications , 2009, Found. Trends Comput. Graph. Vis..

[48]  Christian Hoffmann,et al.  Fast Object Hypotheses Generation Using 3D Position and 3D Motion , 2005, 2005 IEEE Computer Society Conference on Computer Vision and Pattern Recognition (CVPR'05) - Workshops.

[49]  Michael Beetz,et al.  Leaving Flatland: Efficient real‐time three‐dimensional perception and motion planning , 2009, J. Field Robotics.

[50]  Vladimir Polotski,et al.  Autonomous system for navigation and surveying in underground mines , 2007, J. Field Robotics.

[51]  Roberto Manduchi,et al.  Bilateral filtering for gray and color images , 1998, Sixth International Conference on Computer Vision (IEEE Cat. No.98CH36271).

[52]  Jörg Stückler,et al.  Using Time-of-Flight cameras with active gaze control for 3D collision avoidance , 2010, 2010 IEEE International Conference on Robotics and Automation.

[53]  R. Lange,et al.  Solid-state time-of-flight range camera , 2001 .

[54]  T. Kahlmann,et al.  Calibration and development for increased accuracy of 3D range imaging cameras , 2008 .

[55]  Roberto Manduchi,et al.  Obstacle Detection and Terrain Classification for Autonomous Off-Road Navigation , 2005, Auton. Robots.

[56]  Jaime Pulido Fentanes,et al.  A new method for efficient three-dimensional reconstruction of outdoor environments using mobile robots , 2011, J. Field Robotics.

[57]  A. Birk,et al.  Optimized Octtree Datastructure and Access Methods for 3D Mapping , 2007, 2007 IEEE International Workshop on Safety, Security and Rescue Robotics.

[58]  Larry H. Matthies,et al.  Rock modeling and matching for autonomous long‐range Mars rover localization , 2007, J. Field Robotics.

[59]  E. Mjolsness,et al.  AUTONOMOUS ROCK DETECTION FOR MARS TERRAIN , 2001 .

[60]  Andreas Birk,et al.  Surface Representations for 3D Mapping , 2010, KI - Künstliche Intelligenz.

[61]  Wolfram Burgard,et al.  A real-time algorithm for mobile robot mapping with applications to multi-robot and 3D mapping , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[62]  B. Huhle,et al.  Integrating 3D Time-of-Flight Camera Data and High Resolution Images for 3DTV Applications , 2007, 2007 3DTV Conference.

[63]  Takashi Kubota,et al.  Map Matching Scheme for Position Estimation of Planetary Explorer in Natural Terrain , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.