Efficient Task Planning for Mobile Manipulation: a Virtual Kinematic Chain Perspective

We present a Virtual Kinematic Chain (VKC) perspective, a simple yet effective method, to improve task planning efficacy for mobile manipulation. By consolidating the kinematics of the mobile base, the arm, and the object being manipulated collectively as a whole, this novel VKC perspective naturally defines abstract actions and eliminates unnecessary predicates in describing intermediate poses. As a result, these advantages simplify the design of the planning domain and significantly reduce the search space and branching factors in solving planning problems. In experiments, we implement a task planner using Planning Domain Definition Language (PDDL) with VKC. Compared with conventional domain definition, our VKC-based domain definition is more efficient in both planning time and memory. In addition, abstract actions perform better in producing feasible motion plans and trajectories. We further scale up the VKC-based task planner in complex mobile manipulation tasks. Taken together, these results demonstrate that task planning using VKC for mobile manipulation is not only natural and effective but also introduces new capabilities.

[1]  Daniel M. Bodily,et al.  Motion planning for mobile robots using inverse kinematics branching , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Pieter Abbeel,et al.  Combined task and motion planning through an extensible planner-independent interface layer , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Richard Fikes,et al.  STRIPS: A New Approach to the Application of Theorem Proving to Problem Solving , 1971, IJCAI.

[4]  Matteo Parigi Polverini,et al.  An Augmented Kinematic Model for the Cartesian Control of the Hybrid Wheeled-Legged Quadrupedal Robot CENTAURO , 2020, IEEE Robotics and Automation Letters.

[5]  Esra Erdem,et al.  Combining high-level causal reasoning with low-level geometric reasoning and motion planning for robotic manipulation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[6]  Krishna Shankar,et al.  Kinematics and Local Motion Planning for Quasi-static Whole-body Mobile Manipulation , 2016 .

[7]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[8]  R. Bellman.  A Markovian Decision Process , 1957 .

[9]  Pieter Abbeel,et al.  Motion planning with sequential convex optimization and convex collision checking , 2014, Int. J. Robotics Res..

[10]  Leslie Pack Kaelbling,et al.  Learning to guide task and motion planning using score-space representation , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[11]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[12]  Petter Ögren,et al.  Whole Body Control of a Dual-Arm Mobile Robot Using a Virtual Kinematic Chain , 2016, Int. J. Humanoid Robotics.

[13]  Marc Toussaint,et al.  Differentiable Physics and Stable Modes for Tool-Use and Manipulation Planning , 2018, Robotics: Science and Systems.

[14]  Lydia E. Kavraki,et al.  Exploring implicit spaces for constrained sampling-based planning , 2019, Int. J. Robotics Res..

[15]  Chenfanfu Jiang,et al.  Mirroring without Overimitation: Learning Functionally Equivalent Manipulation Actions , 2019, AAAI.

[16]  Maxim Likhachev,et al.  Planning for autonomous door opening with a mobile manipulator , 2010, 2010 IEEE International Conference on Robotics and Automation.

[17]  Chee-Meng Chew,et al.  Virtual Model Control: An Intuitive Approach for Bipedal Locomotion , 2001, Int. J. Robotics Res..

[18]  Leslie Pack Kaelbling,et al.  Integrated Task and Motion Planning , 2020, Annu. Rev. Control. Robotics Auton. Syst..

[19]  Marc Toussaint,et al.  Logic-Geometric Programming: An Optimization-Based Approach to Combined Task and Motion Planning , 2015, IJCAI.

[20]  Leslie Pack Kaelbling,et al.  FFRob: Leveraging symbolic planning for efficient task and motion planning , 2016, Int. J. Robotics Res..

[21]  Petter Ögren,et al.  Cooperative control of a serial-to-parallel structure using a virtual kinematic chain in a mobile dual-arm manipulation application , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[22]  Jerry E. Pratt,et al.  Virtual model control of a bipedal walking robot , 1997, Proceedings of International Conference on Robotics and Automation.

[23]  Song-Chun Zhu,et al.  A tale of two explanations: Enhancing human trust by explaining robot behavior , 2019, Science Robotics.

[24]  Bojan Nemec,et al.  Virtual Mechanism Approach for Dual-arm Manipulation , 2012, ICINCO.

[25]  Maria Fox,et al.  PDDL2.1: An Extension to PDDL for Expressing Temporal Planning Domains , 2003, J. Artif. Intell. Res..

[26]  Hector Geffner,et al.  Width-based Algorithms for Classical Planning: New Results , 2014, ECAI.

[27]  Erez Karpas,et al.  Automated Planning for Robotics , 2020, Annu. Rev. Control. Robotics Auton. Syst..

[28]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[29]  Dana S. Nau,et al.  SHOP2: An HTN Planning System , 2003, J. Artif. Intell. Res..

[30]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

[31]  Leslie Pack Kaelbling,et al.  Hierarchical task and motion planning in the now , 2011, 2011 IEEE International Conference on Robotics and Automation.

[32]  Song-Chun Zhu,et al.  Consolidating Kinematic Models to Promote Coordinated Mobile Manipulations , 2021, 2021 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[33]  Alessandro Saffiotti,et al.  Geometric backtracking for combined task and motion planning in robotic systems , 2017, Artif. Intell..

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