Distributed Force/Position Optimization Dynamics for Cooperative Unknown Payload Manipulation*

We consider the problem of manipulating an unknown payload using multiple agents. The objective is to find both optimal grasping positions and input forces for agents to apply so that the resulting linear and angular velocities make the rigid object track a reference. The associated optimization problem is split into force and position subproblems. The primal–dual gradient dynamics for the force subproblem can be completely decoupled into local dynamics that each agent can implement using only local measurements. The proximal gradient dynamics for the position subproblem require only local object shape information and relative positions between adjacent agents. We prove that combining the optimization dynamics for these subproblems yields an algorithm that converges to a locally optimal point for the joint force-position problem, and provide numerical simulations that demonstrate its performance on practical problems.

[1]  Rui Fukui,et al.  Multirobot Object Transport via Robust Caging , 2020, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[2]  Hassan K. Khalil,et al.  Nonlinear Systems Third Edition , 2008 .

[3]  Francesco Pierri,et al.  A two stage approach for distributed cooperative manipulation of an unknown object without explicit communication and unknown number of robots , 2018, Robotics Auton. Syst..

[4]  Patrick L. Combettes,et al.  Signal Recovery by Proximal Forward-Backward Splitting , 2005, Multiscale Model. Simul..

[5]  Huan Li,et al.  Accelerated Proximal Gradient Methods for Nonconvex Programming , 2015, NIPS.

[6]  Dimos V. Dimarogonas,et al.  Robust Cooperative Manipulation Without Force/Torque Measurements: Control Design and Experiments , 2017, IEEE Transactions on Control Systems Technology.

[7]  P. P. J. van den Bosch,et al.  On Constrained Steady-State Regulation: Dynamic KKT Controllers , 2009, IEEE Transactions on Automatic Control.

[8]  Enrique Mallada,et al.  Optimal Steady-State Control for Linear Time-Invariant Systems , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[9]  Spring Berman,et al.  Decentralized sliding mode control for autonomous collective transport by multi-robot systems , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[10]  Spring Berman,et al.  Design of ant-inspired stochastic control policies for collective transport by robotic swarms , 2014, Swarm Intelligence.

[11]  Tsuneo Yoshikawa,et al.  Manipulability of Robotic Mechanisms , 1985 .

[12]  Xuan Zhang,et al.  Distributed optimal steady-state control using reverse- and forward-engineering , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[13]  Gregory B. Passty.  Ergodic convergence to a zero of the sum of monotone operators in Hilbert space , 1979 .

[14]  Magnus Egerstedt,et al.  Primal–Dual Gradient Dynamics for Cooperative Unknown Payload Manipulation without Communication* , 2020, 2020 American Control Conference (ACC).

[15]  Antonio Franchi,et al.  Distributed Estimation of State and Parameters in Multiagent Cooperative Load Manipulation , 2016, IEEE Transactions on Control of Network Systems.

[16]  Takeshi Hatanaka,et al.  Physics-integrated hierarchical/distributed HVAC optimization for multiple buildings with robustness against time delays , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[17]  Sandra Hirche,et al.  Load sharing in human-robot cooperative manipulation , 2010, 19th International Symposium in Robot and Human Interactive Communication.

[18]  John T. Wen,et al.  Motion coordination through cooperative payload transport , 2009, 2009 American Control Conference.

[19]  T. Kose.  Solutions of Saddle Value Problems by Differential Equations , 1956 .

[20]  Jie Chen,et al.  Cooperative transportation control of multiple mobile manipulators through distributed optimization , 2018, Science China Information Sciences.

[21]  Spring Berman,et al.  Stability and Convergence Analysis of a Decentralized Proportional-Integral Control Strategy for Collective Transport , 2018, 2018 Annual American Control Conference (ACC).

[22]  Stephen P. Boyd,et al.  Distributed Optimization and Statistical Learning via the Alternating Direction Method of Multipliers , 2011, Found. Trends Mach. Learn..

[23]  Chin Pei Tang,et al.  Manipulability-based configuration evaluation of cooperative payload transport by mobile manipulator collectives , 2006, Robotica.

[24]  P. Tseng.  Applications of splitting algorithm to decomposition in convex programming and variational inequalities , 1991 .

[25]  Magnus Egerstedt,et al.  Graph Theoretic Methods in Multiagent Networks , 2010, Princeton Series in Applied Mathematics.

[26]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[27]  Shuai Li,et al.  Manipulability Optimization of Redundant Manipulators Using Dynamic Neural Networks , 2017, IEEE Transactions on Industrial Electronics.