Motion Planning for Multi-Mobile-Manipulator Payload Transport Systems

In this paper, a kinematic motion planning algorithm for cooperative spatial payload manipulation is presented. A hierarchical approach is introduced to compute realtime collision-free motion plans for a formation of mobile manipulator robots. Initially, collision-free configurations of a deformable 2-D virtual bounding box are identified, over a planning horizon, to determine a convex workspace for the entire system. Then, 3-D payload configurations whose projections lie within the convex workspace are computed. Finally, a convex decentralized model-predictive controller is formulated to plan collision-free trajectories for the formation of mobile manipulators. Our work facilitates real-time motion planning for the system and is scalable in the number of robots. The algorithm is validated in simulated dynamic environments.

[1]  Khalil Alipour,et al.  Optimal formation and control of cooperative wheeled mobile robots , 2015 .

[2]  Tucker R. Balch,et al.  Behavior-based formation control for multirobot teams , 1998, IEEE Trans. Robotics Autom..

[3]  Kar-Han Tan,et al.  High Precision Formation Control of Mobile Robots Using Virtual Structures , 1997, Auton. Robots.

[4]  Michael J. Black,et al.  Decentralized MPC based Obstacle Avoidance for Multi-Robot Target Tracking Scenarios , 2018, 2018 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[5]  Chin Pei Tang,et al.  A Screw-Theoretic Analysis Framework for Payload Manipulation by Mobile Manipulator Collectives , 2005 .

[6]  Ross A. Knepper,et al.  Local motion planning for collaborative multi-robot manipulation of deformable objects , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Javier Alonso-Mora,et al.  Distributed multi-robot formation control among obstacles: A geometric and optimization approach with consensus , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[8]  Mu Fang,et al.  Adaptive Tracking Control of Coordinated Nonholonomic Mobile Manipulators , 2008 .

[9]  Saeid Nahavandi,et al.  Transportation by Multiple Mobile Manipulators in Unknown Environments With Obstacles , 2017, IEEE Systems Journal.

[10]  Soon-Jo Chung,et al.  Swarm assignment and trajectory optimization using variable-swarm, distributed auction assignment and sequential convex programming , 2016, Int. J. Robotics Res..

[11]  Heinrich H. Bülthoff,et al.  Active Perception Based Formation Control for Multiple Aerial Vehicles , 2019, IEEE Robotics and Automation Letters.

[12]  Vijay Kumar,et al.  A semidefinite programming framework for controlling multi-robot systems in dynamic environments , 2010, 49th IEEE Conference on Decision and Control (CDC).

[13]  Stephen P. Boyd,et al.  OSQP: an operator splitting solver for quadratic programs , 2017, 2018 UKACC 12th International Conference on Control (CONTROL).

[14]  Vijay Kumar,et al.  Modeling and control of formations of nonholonomic mobile robots , 2001, IEEE Trans. Robotics Autom..

[15]  Javier Alonso-Mora,et al.  Multi-robot navigation in formation via sequential convex programming , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[16]  Kostas J. Kyriakopoulos,et al.  Nonholonomic navigation and control of cooperating mobile manipulators , 2003, IEEE Trans. Robotics Autom..

[17]  Heinrich H. Bülthoff,et al.  Deep Neural Network-Based Cooperative Visual Tracking Through Multiple Micro Aerial Vehicles , 2018, IEEE Robotics and Automation Letters.

[18]  Vijay Kumar,et al.  Cooperative Grasping and Transport Using Multiple Quadrotors , 2010, DARS.

[19]  Oussama Khatib,et al.  Coordination and decentralized cooperation of multiple mobile manipulators , 1996, J. Field Robotics.

[20]  Rajankumar Bhatt,et al.  Formation optimization for a fleet of wheeled mobile robots - A geometric approach , 2009, Robotics Auton. Syst..