Adaptive Motion Planning for Autonomous Rough Terrain Traversal with a Walking Robot

Achieving full autonomy in a mobile robot requires combining robust environment perception with onboard sensors, efficient environment mapping, and real-time motion planning. All these tasks become more challenging when we consider a natural, outdoor environment and a robot that has many degrees of freedom DOF. In this paper, we address the issues of motion planning in a legged robot walking over a rough terrain, using only its onboard sensors to gather the necessary environment model. The proposed solution takes the limited perceptual capabilities of the robot into account. A multisensor system is considered for environment perception. The key idea of the motion planner is to use the dual representation concept of the map: i a higher-level planner applies the A* algorithm for coarse path planning on a low-resolution elevation grid, and ii a lower-level planner applies the guided-RRT rapidly exploring random tree algorithm to find a sequence of feasible motions on a more precise but smaller map. This paper contributes a new method that can identify the terrain traversability cost to the benefit of the A* algorithm. A probabilistic regression technique is applied for the traversability assessment with the typical RRT-based motion planner used to explore the space of traversability values. The efficiency of our motion planning approach is demonstrated in simulations that provide ground truth data unavailable in field tests. However, the simulation-verified approach is then thoroughly tested under real-world conditions in experiments with two six-legged walking robots having different perception systems.

[1]  Piotr Skrzypczynski,et al.  Rough terrain mapping and classification for foothold selection in a walking robot , 2010, 2010 IEEE Safety Security and Rescue Robotics.

[2]  Sander Oude Elberink,et al.  Accuracy and Resolution of Kinect Depth Data for Indoor Mapping Applications , 2012, Sensors.

[3]  Piotr Skrzypczynski,et al.  An exploration-based approach to terrain traversability assessment for a walking robot , 2013, 2013 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[4]  Wolfram Burgard,et al.  A Bayesian regression approach to terrain mapping and an application to legged robot locomotion , 2009 .

[5]  Rüdiger Dillmann,et al.  LAURON V: A versatile six-legged walking robot with advanced maneuverability , 2014, 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[6]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[7]  Piotr Skrzypczynski,et al.  Precise self-localization of a walking robot on rough terrain using parallel tracking and mapping , 2013, Ind. Robot.

[8]  Piotr Skrzypczynski,et al.  A biologically inspired approach to feasible gait learning for a hexapod robot , 2010, Int. J. Appl. Math. Comput. Sci..

[9]  Daniel D. Lee,et al.  Search-based planning for a legged robot over rough terrain , 2009, 2009 IEEE International Conference on Robotics and Automation.

[10]  Tsukasa Ogasawara,et al.  Learning strategy fusion for acquiring crawling behavior in multiple environments , 2013, 2013 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[11]  Katie Byl,et al.  More solutions means more problems: Resolving kinematic redundancy in robot locomotion on complex terrain , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[13]  Jizhong Xiao,et al.  Multi-volume occupancy grids: An efficient probabilistic 3D mapping model for micro aerial vehicles , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Shaoping Bai,et al.  Terrain evaluation and its application to path planning for walking machines , 2001, Adv. Robotics.

[15]  Przemysław Łabecki Improved Data Processing for an Embedded Stereo Vision System of an Inspection Robot , 2011 .

[16]  P. Skrzypczyński,et al.  Terrain map building for a walking robot equipped with an active 2D range sensor , 2011 .

[17]  G. Klein,et al.  Parallel Tracking and Mapping for Small AR Workspaces , 2007, 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality.

[18]  Cang Ye,et al.  Characterization of the Hokuyo URG-04LX laser rangefinder for mobile robot obstacle negotiation , 2009, Defense + Commercial Sensing.

[19]  Thierry Siméon,et al.  Motion generation for a rover on rough terrains , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[20]  Steven M. LaValle,et al.  Steps toward derandomizing RRTs , 2004, Proceedings of the Fourth International Workshop on Robot Motion and Control (IEEE Cat. No.04EX891).

[21]  Dominik Belter,et al.  Integrated Motion Planning for a Hexapod Robot Walking on Rough Terrain , 2011 .

[22]  James S. Albus,et al.  Learning traversability models for autonomous mobile vehicles , 2008, Auton. Robots.

[23]  Jaime Valls Miró,et al.  Planning high-visibility stable paths for reconfigurable robots on uneven terrain , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Cang Ye,et al.  A novel filter for terrain mapping with laser rangefinders , 2004, IEEE Transactions on Robotics.

[25]  Tsukasa Ogasawara,et al.  DCOB: Action space for reinforcement learning of high DoF robots , 2013, Autonomous Robots.

[26]  Edward Tunstel,et al.  Soft computing for visual terrain perception and traversability assessment by planetary robotic systems , 2005, 2005 IEEE International Conference on Systems, Man and Cybernetics.

[27]  Jinhan Lee,et al.  Cost based planning with RRT in outdoor environments , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Reid G. Simmons,et al.  Variable sized grid cells for rapid replanning in dynamic environments , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[29]  Alexander C. Shkolnik Sample-based motion planning in high-dimensional and differentially-constrained systems , 2010 .

[30]  Wolfram Burgard,et al.  A Bayesian regression approach to terrain mapping and an application to legged robot locomotion , 2009, J. Field Robotics.

[31]  Kurt Konolige,et al.  Small Vision Systems: Hardware and Implementation , 1998 .

[32]  Dominik Belter GAIT MODIFICATION STRATEGY FOR A SIX-LEGGED ROBOT WALKING ON ROUGH TERRAIN , 2012 .

[33]  Heiko Hirschmüller,et al.  Stereo-vision-based navigation of a six-legged walking robot in unknown rough terrain , 2012, Int. J. Robotics Res..

[34]  Kalyanmoy Deb,et al.  Optimal path and gait generations simultaneously of a six-legged robot using a GA-fuzzy approach , 2002, Robotics Auton. Syst..

[35]  Krzysztof Walas,et al.  A Compact Walking Robot - Flexible Research and Development Platform , 2014, Recent Advances in Automation, Robotics and Measuring Techniques.

[36]  Piotr Skrzypczynski,et al.  On-Board Perception and Motion Planning for Legged Locomotion over Rough Terrain , 2011, ECMR.

[37]  Piotr Skrzypczynski,et al.  Map-based adaptive foothold planning for unstructured terrain walking , 2010, 2010 IEEE International Conference on Robotics and Automation.

[38]  Satoshi Kagami,et al.  Autonomous navigation of a humanoid robot over unknown rough terrain using a laser range sensor , 2012, Int. J. Robotics Res..

[39]  Piotr Skrzypczynski,et al.  Estimating terrain elevation maps from sparse and uncertain multi-sensor data , 2012, 2012 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[40]  Rüdiger Dillmann,et al.  Adaptation of a six-legged walking robot to its local environment , 2009 .

[41]  Abraham Sánchez López,et al.  Sampling-Based Motion Planning: A Survey , 2008, Computación y Sistemas.

[42]  T. Kubota,et al.  Path planning for newly developed microrover , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[43]  Darwin G. Caldwell,et al.  A comparison of search-based planners for a legged robot , 2013, 9th International Workshop on Robot Motion and Control.

[44]  Andrew Y. Ng,et al.  Stereo vision and terrain modeling for quadruped robots , 2009, 2009 IEEE International Conference on Robotics and Automation.

[45]  Stefan Schaal,et al.  Fast, robust quadruped locomotion over challenging terrain , 2010, 2010 IEEE International Conference on Robotics and Automation.

[46]  Reid G. Simmons,et al.  Perception, Planning, and Control for Autonomous Walking With the Ambler Planetary Rover , 1996, Int. J. Robotics Res..

[47]  Andrew Y. Ng,et al.  A control architecture for quadruped locomotion over rough terrain , 2008, 2008 IEEE International Conference on Robotics and Automation.

[48]  Robert B. McGhee,et al.  Adaptive Locomotion of a Multilegged Robot over Rough Terrain , 1979, IEEE Transactions on Systems, Man, and Cybernetics.

[49]  Panagiotis Papadakis,et al.  Terrain traversability analysis methods for unmanned ground vehicles: A survey , 2013, Eng. Appl. Artif. Intell..

[50]  Satoshi Kagami,et al.  Biped navigation in rough environments using on-board sensing , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[51]  Timothy Bretl,et al.  Motion Planning for a Six-Legged Lunar Robot , 2006, WAFR.

[52]  Dominik Belter,et al.  Sensory system calibration method for a walking robot , 2013 .

[53]  Maren Bennewitz,et al.  Anytime search-based footstep planning with suboptimality bounds , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[54]  Krzysztof Walas,et al.  Terrain classification using Laser Range Finder , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[55]  Larry D. Hostetler,et al.  The estimation of the gradient of a density function, with applications in pattern recognition , 1975, IEEE Trans. Inf. Theory.

[56]  Masayuki Inaba,et al.  Dynamically-Stable Motion Planning for Humanoid Robots , 2002, Auton. Robots.

[57]  Takafumi Kanamori,et al.  Nonparametric Conditional Density Estimation Using Piecewise-Linear Solution Path of Kernel Quantile Regression , 2009, Neural Computation.

[58]  Krzysztof Walas,et al.  Control and environment sensing system for a six-legged robot , 2008 .

[59]  Dominik Belter Optimization - based approach for motion planning of a robot walking on rough terrain , 2013 .

[60]  Piotr Skrzypczyński,et al.  Spatial Uncertainty Assessment in Visual Terrain Perception for a Mobile Robot , 2014 .

[61]  Alfred A. Rizzi,et al.  Autonomous navigation for BigDog , 2010, 2010 IEEE International Conference on Robotics and Automation.

[62]  Piotr Skrzypczynski,et al.  Posture optimization strategy for a statically stable robot traversing rough terrain , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[63]  Dominik Belter Perception-Based Motion Planning for a Walking Robot in Rugged Terrain , 2012 .

[64]  Fiora Pirri,et al.  3D Mobility Learning and Regression of Articulated, Tracked Robotic Vehicles by Physics-based Optimization , 2012, VRIPHYS.

[65]  Timothy Bretl,et al.  Motion Planning for Legged Robots on Varied Terrain , 2008, Int. J. Robotics Res..

[66]  Thierry Siméon,et al.  Transition-based RRT for path planning in continuous cost spaces , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[67]  Michal R. Nowicki,et al.  Combining photometric and depth data for lightweight and robust visual odometry , 2013, 2013 European Conference on Mobile Robots.

[68]  Joel E. Chestnutt,et al.  Navigation and Gait Planning , 2010 .

[69]  Dolores Blanco,et al.  Outdoor Motion Planning Using Fast Marching , 2009 .

[70]  Moonhong Baeg,et al.  Spatial Uncertainty Model for Visual Features Using a Kinect™ Sensor , 2012, Sensors.

[71]  G. Schmidt,et al.  Vision-Guided Walking in a Structured Indoor Scenario , 2005 .

[72]  Riccardo Poli,et al.  Particle swarm optimization , 1995, Swarm Intelligence.

[73]  Olivier Stasse,et al.  Fast Humanoid Robot Collision-Free Footstep Planning Using Swept Volume Approximations , 2012, IEEE Transactions on Robotics.

[74]  Michael Beetz,et al.  Gaussian process modeling of large-scale terrain , 2009 .

[75]  Libor Preucil,et al.  RRT-path – A Guided Rapidly Exploring Random Tree , 2009 .

[76]  Roland Siegwart,et al.  HAPTIC FOOTHOLD SUITABILITY IDENTIFICATION AND PREDICTION FOR LEGGED ROBOTS , 2014 .

[77]  Larry H. Matthies,et al.  High fidelity day/night stereo mapping with vegetation and negative obstacle detection for vision-in-the-loop walking , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[78]  Homayoun Seraji,et al.  Vision-based terrain characterization and traversability assessment , 2001, J. Field Robotics.

[79]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[80]  Carl Tim Kelley,et al.  Iterative methods for optimization , 1999, Frontiers in applied mathematics.

[81]  Regis Hoffman,et al.  Terrain mapping for a walking planetary rover , 1994, IEEE Trans. Robotics Autom..