Kinodynamic motion planning for high-dimensional physical systems

This thesis presents a kinodynamic motion planner, Kinodynamic Motion Planning by Interior-Exterior Cell Exploration (KPIECE), specifically designed for systems with complex dynamics, where physics-based simulation is necessary. A multiple-level grid-based discretization is used to estimate the coverage of the state space. The coverage estimates help the planner detect the less explored areas of the state space. The planner also keeps track of the boundary of the explored region of the state space and focuses exploration on the less covered parts of this boundary. Extensive experiments show KPIECE provides computational gain over state-of-the-art methods and allows solving some harder, previously unsolvable problems. A shared memory parallel implementation is presented as well. This implementation provides better speedup than an embarrassingly parallel implementation by taking advantage of the evolving multi-core technology. Acknowledgements First of all, I would like to thank my advisor, Dr. Lydia Kavraki, for her guidance and help with this work, and the Physical and Biological Computing Group for their valuable comments and suggestions. I would like to thank Mark Yim and Jonathan Kruse for their help in defining the CKBot ODE model. Many thanks go to Marius S ¸ucan for designing most of the images this document includes, and to Derek Ruths for naming the algorithm (KPIECE).

[1]  John H. Reif,et al.  Optimal Kinodynamic Motion Planning for 2D Reconfiguration of Self-Reconfigurable Robots , 2007, Robotics: Science and Systems.

[2]  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).

[3]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[4]  Mark Yim,et al.  Dynamic Rolling for a Modular Loop Robot , 2006, ISER.

[5]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[6]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

[7]  Thierry Siméon,et al.  Visibility based probabilistic roadmaps , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[8]  Lydia E. Kavraki,et al.  Path planning using lazy PRM , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[9]  Vijay Kumar,et al.  Decidability of Motion Planning with Differential Constraints , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[10]  Lydia E. Kavraki,et al.  Analysis of probabilistic roadmaps for path planning , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[11]  Masayuki Inaba,et al.  Motion Planning for Humanoid Robots , 2003, ISRR.

[12]  Nancy M. Amato,et al.  Probabilistic roadmap methods are embarrassingly parallel , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[13]  Stefano Caselli,et al.  Randomized motion planning on parallel and distributed architectures , 1999, Proceedings of the Seventh Euromicro Workshop on Parallel and Distributed Processing. PDP'99.

[14]  Nidhi Kalra,et al.  Replanning with RRTs , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[15]  John F. Canny,et al.  Some algebraic and geometric computations in PSPACE , 1988, STOC '88.

[16]  Thierry Siméon,et al.  Adaptive tuning of the sampling domain for dynamic-domain RRTs , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  J. Schwartz,et al.  On the Piano Movers' Problem: III. Coordinating the Motion of Several Independent Bodies: The Special Case of Circular Bodies Moving Amidst Polygonal Barriers , 1983 .

[18]  Steven M. LaValle,et al.  Current Issues in Sampling-Based Motion Planning , 2005, ISRR.

[19]  John H. Reif,et al.  Complexity of the mover's problem and generalizations , 1979, 20th Annual Symposium on Foundations of Computer Science (sfcs 1979).

[20]  Emilio Frazzoli,et al.  Improving the performance of sampling-based planners by using a symmetry-exploiting gap reduction algorithm , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[21]  Jean-Claude Latombe,et al.  Robot Motion Planning: A Distributed Representation Approach , 1991, Int. J. Robotics Res..

[22]  Lydia E. Kavraki,et al.  Sampling-based robot motion planning: Towards realistic applications , 2007, Comput. Sci. Rev..

[23]  Mark Yim,et al.  Kinodynamic motion planning with hardware demonstrations , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Kostas E. Bekris,et al.  OOPS for Motion Planning: An Online, Open-source, Programming System , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[25]  山田 祐,et al.  Open Dynamics Engine を用いたスノーボードロボットシミュレータの開発 , 2007 .

[26]  Kostas E. Bekris,et al.  Sampling-based roadmap of trees for parallel motion planning , 2005, IEEE Transactions on Robotics.

[27]  Rajeev Motwani,et al.  Path Planning in Expansive Configuration Spaces , 1999, Int. J. Comput. Geom. Appl..

[28]  Lydia E. Kavraki,et al.  Fast Tree-Based Exploration of State Space for Robots with Dynamics , 2004, WAFR.

[29]  Stefano Carpin,et al.  Randomized Motion Planning: a Tutorial , 2006, Int. J. Robotics Autom..

[30]  Lydia E. Kavraki,et al.  Discrete Search Leading Continuous Exploration for Kinodynamic Motion Planning , 2007, Robotics: Science and Systems.

[31]  Oliver Brock,et al.  Single-Query Motion Planning with Utility-Guided Random Trees , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[32]  Nancy M. Amato,et al.  RESAMPL: A Region-Sensitive Adaptive Motion Planner , 2008, WAFR.

[33]  Lydia E. Kavraki,et al.  Randomized query processing in robot path planning , 1995, STOC '95.

[34]  Kostas E. Bekris,et al.  Greedy but Safe Replanning under Kinodynamic Constraints , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[35]  Bruce Randall Donald,et al.  Kinodynamic motion planning , 1993, JACM.

[36]  Thierry Siméon,et al.  Dynamic-Domain RRTs: Efficient Exploration by Controlling the Sampling Domain , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[37]  Mark Yim,et al.  Reconfiguration for Modular Robots Using Kinodynamic Motion Planning , 2008 .

[38]  J. Laumond,et al.  An iterative diffusion algorithm for part disassembly , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[39]  Jean-Claude Latombe,et al.  Motion Planning: A Journey of Robots, Molecules, Digital Actors, and Other Artifacts , 1999, Int. J. Robotics Res..

[40]  Florent Lamiraux,et al.  Kinodynamic motion planning: connecting exploration trees using trajectory optimization Methods , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[41]  J. V. D. Berg,et al.  Path Planning in Repetitive Environments , 2006 .

[42]  Ming C. Lin,et al.  Collision Detection between Geometric Models: A Survey , 1998 .

[43]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[44]  Lydia Tapia,et al.  A Machine Learning Approach for Feature-Sensitive Motion Planning , 2004, WAFR.

[45]  J. Schwartz,et al.  On the “piano movers” problem. II. General techniques for computing topological properties of real algebraic manifolds , 1983 .

[46]  Howie Choset,et al.  Principles of Robot Motion: Theory, Algorithms, and Implementation ERRATA!!!! 1 , 2007 .

[47]  Jean-Claude Latombe,et al.  Stochastic roadmap simulation: an efficient representation and algorithm for analyzing molecular motion , 2002, RECOMB '02.

[48]  Lydia Tapia,et al.  Simulating Protein Motions with Rigidity Analysis , 2007, J. Comput. Biol..

[49]  Lydia E. Kavraki,et al.  Motion Planning in the Presence of Drift, Underactuation and Discrete System Changes , 2005, Robotics: Science and Systems.

[50]  Dinesh Manocha,et al.  Reactive deformation roadmaps: motion planning of multiple robots in dynamic environments , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[51]  Jean-Claude Latombe,et al.  A Single-Query Bi-Directional Probabilistic Roadmap Planner with Lazy Collision Checking , 2001, ISRR.

[52]  Lydia E. Kavraki,et al.  Measure theoretic analysis of probabilistic path planning , 2004, IEEE Transactions on Robotics and Automation.