Distributed Estimation of State and Parameters in Multiagent Cooperative Load Manipulation

We present two distributed methods for the estimation of the kinematic parameters, the dynamic parameters, and the kinematic state of an unknown planar body manipulated by a decentralized multiagent system. The proposed approaches rely on the rigid body kinematics and dynamics, on nonlinear observation theory, and on consensus algorithms. The only three requirements are that each agent can exert a 2-D wrench on the load, it can measure the velocity of its contact point, and that the communication graph is connected. Both theoretical nonlinear observability analysis and convergence proofs are provided. The first method assumes constant parameters, while the second one can deal with time-varying parameters and can be applied in parallel to any task-oriented control law. For the cases in which a control law is not provided, we propose a distributed and safe control strategy satisfying the observability condition. The effectiveness and robustness of the estimation strategy are showcased by means of realistic Monte Carlo simulations.

[1]  Xiaoming Hu,et al.  Distributed cooperative object attitude manipulation , 2012, 2012 IEEE International Conference on Robotics and Automation.

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

[3]  Reza Olfati-Saber,et al.  Consensus and Cooperation in Networked Multi-Agent Systems , 2007, Proceedings of the IEEE.

[4]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[5]  Antonio Franchi,et al.  Reshaping the physical properties of a quadrotor through IDA-PBC and its application to aerial physical interaction , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Friedrich M. Wahl,et al.  On-line estimation of inertial parameters using a recursive total least-squares approach , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  Sonia Martínez,et al.  Discrete-time dynamic average consensus , 2010, Autom..

[8]  Sandra Hirche,et al.  Adaptive force/velocity control for multi-robot cooperative manipulation under uncertain kinematic parameters , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  Mac Schwager,et al.  Decentralized Adaptive Control for Collaborative Manipulation , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Antonio Franchi,et al.  A passivity-based decentralized strategy for generalized connectivity maintenance , 2013, Int. J. Robotics Res..

[11]  S. Tsujio,et al.  Inertia parameter estimation of planar object in pushing operation , 2005, 2005 IEEE International Conference on Information Acquisition.

[12]  Yuan F. Zheng,et al.  Two strategies of position and force control for two industrial robots handling a single object , 1989, Robotics Auton. Syst..

[13]  Ian D. Walker,et al.  Analysis of Motion and Internal Loading of Objects Grasped by Multiple Cooperating Manipulators , 1991, Int. J. Robotics Res..

[14]  Murti V Salapaka,et al.  Distributed protocol for determining when averaging consensus is reached , 2007 .

[15]  Frédéric Plumet,et al.  Planning and controlling cooperating robots through distributed impedance , 2002, J. Field Robotics.

[16]  Antonio Franchi,et al.  The flying hand: A formation of UAVs for cooperative aerial tele-manipulation , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[17]  Weiping Li,et al.  Applied Nonlinear Control , 1991 .

[18]  Antonio Franchi,et al.  Decentralized motion control for cooperative manipulation with a team of networked mobile manipulators , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[19]  Antonio Franchi,et al.  Turning a near-hovering controlled quadrotor into a 3D force effector , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[20]  Christoforos N. Hadjicostis,et al.  Distributed Stopping for Average Consensus in Digraphs , 2018, IEEE Transactions on Control of Network Systems.

[21]  Mac Schwager,et al.  Multi-robot manipulation with no communication using only local measurements , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[22]  Antonio Franchi,et al.  Distributed estimation of the inertial parameters of an unknown load via multi-robot manipulation , 2014, 53rd IEEE Conference on Decision and Control.

[23]  Stanley A. Schneider,et al.  Object impedance control for cooperative manipulation: theory and experimental results , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[24]  Valmir Carneiro Barbosa,et al.  An introduction to distributed algorithms , 1996 .

[25]  Farhad Aghili,et al.  Adaptive Control of Manipulators Forming Closed Kinematic Chain With Inaccurate Kinematic Model , 2013, IEEE/ASME Transactions on Mechatronics.

[26]  Antonio Franchi,et al.  Decentralized parameter estimation and observation for cooperative mobile manipulation of an unknown load using noisy measurements , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[27]  John N. Tsitsiklis,et al.  Convergence Speed in Distributed Consensus and Averaging , 2009, SIAM J. Control. Optim..

[28]  Giuseppe Carlo Calafiore,et al.  Distributed centroid estimation from noisy relative measurements , 2012, Syst. Control. Lett..

[29]  Manfredi Maggiore,et al.  Models of Mobile Robots in the Plane , 2016 .

[30]  Sandra Hirche,et al.  Formation-based approach for multi-robot cooperative manipulation based on optimal control design , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Sonia Martínez,et al.  Singularly perturbed algorithms for dynamic average consensus , 2013, 2013 European Control Conference (ECC).