Geometry-aware manipulability learning, tracking, and transfer

Body posture influences human and robots performance in manipulation tasks, as appropriate poses facilitate motion or force exertion along different axes. In robotics, manipulability ellipsoids arise as a powerful descriptor to analyze, control and design the robot dexterity as a function of the articulatory joint configuration. This descriptor can be designed according to different task requirements, such as tracking a desired position or apply a specific force. In this context, this paper presents a novel \emph{manipulability transfer} framework, a method that allows robots to learn and reproduce manipulability ellipsoids from expert demonstrations. The proposed learning scheme is built on a tensor-based formulation of a Gaussian mixture model that takes into account that manipulability ellipsoids lie on the manifold of symmetric positive definite matrices. Learning is coupled with a geometry-aware tracking controller allowing robots to follow a desired profile of manipulability ellipsoids. Extensive evaluations in simulation with redundant manipulators, a robotic hand and humanoids agents, as well as an experiment with two real dual-arm systems validate the feasibility of the approach.

[1]  Bin Yao,et al.  Feasible Center of Mass Dynamic Manipulability of humanoid robots , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Tamara G. Kolda,et al.  Tensor Decompositions and Applications , 2009, SIAM Rev..

[3]  Carme Torras,et al.  Learning Physical Collaborative Robot Behaviors From Human Demonstrations , 2016, IEEE Transactions on Robotics.

[4]  Peter J. Basser,et al.  Spectral decomposition of a 4th-order covariance tensor: Applications to diffusion tensor MRI , 2007, Signal Process..

[5]  Nikolaos G. Tsagarakis,et al.  On the role of robot configuration in Cartesian stiffness control , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Francesc Moreno-Noguer,et al.  3D Human Pose Tracking Priors using Geodesic Mixture Models , 2017, International Journal of Computer Vision.

[7]  Jun-Ho Oh,et al.  Humanoid Posture Selection for Reaching Motion and a Cooperative Balancing Controller , 2016, J. Intell. Robotic Syst..

[8]  Darwin G. Caldwell,et al.  PyRoboLearn: A Python Framework for Robot Learning Practitioners , 2019, CoRL.

[9]  Chang-Soo Han,et al.  Energy-efficient gait pattern generation of the powered robotic exoskeleton using DME , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Jun Nakanishi,et al.  Inverse kinematics with floating base and constraints for full body humanoid robot control , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[11]  James W. Davis,et al.  A recursive filter for linear systems on Riemannian manifolds , 2008, 2008 IEEE Conference on Computer Vision and Pattern Recognition.

[12]  Suvrit Sra,et al.  Conic Geometric Optimization on the Manifold of Positive Definite Matrices , 2013, SIAM J. Optim..

[13]  Jörn Malzahn,et al.  Development of a human size and strength compliant bi-manual platform for realistic heavy manipulation tasks , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Darwin G. Caldwell,et al.  An Approach for Imitation Learning on Riemannian Manifolds , 2017, IEEE Robotics and Automation Letters.

[15]  Satoshi Kagami,et al.  Manipulability optimization for trajectory generation , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[16]  Herman Bruyninckx,et al.  Symbolic differentiation of the velocity mapping for a serial kinematic chain , 1996 .

[17]  Michael N. Mistry,et al.  Dynamic manipulability of the center of mass: A tool to study, analyse and measure physical ability of robots , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[18]  S. Chiu,et al.  Control of redundant manipulators for task compatibility , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[19]  Tsuneo Yoshikawa,et al.  Dynamic manipulability of robot manipulators , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[20]  John M. Lee Introduction to Smooth Manifolds , 2002 .

[21]  Michael I. Jordan,et al.  Obstacle Avoidance and a Perturbation Sensitivity Model for Motor Planning , 1997, The Journal of Neuroscience.

[22]  Marc Toussaint,et al.  Understanding the geometry of workspace obstacles in Motion Optimization , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Suvrit Sra,et al.  A new metric on the manifold of kernel matrices with application to matrix geometric means , 2012, NIPS.

[24]  F. Pierrot,et al.  Force polytope and force ellipsoid for redundant manipulators , 1997 .

[25]  Giulio Sandini,et al.  Manipulability analysis , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[26]  Alois Knoll,et al.  Task level robot programming using prioritized non-linear inequality constraints , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[27]  F. Park,et al.  Manipulability of Closed Kinematic Chains , 1998 .

[28]  Jun Morimoto,et al.  Assistive Arm-Exoskeleton Control Based on Human Muscular Manipulability , 2019, Front. Neurorobot..

[29]  J. Y. S. Luh,et al.  Constrained Relations between Two Coordinated Industrial Robots for Motion Control , 1987 .

[30]  Antonio Bicchi,et al.  On the manipulability ellipsoids of underactuated robotic hands with compliance , 2012, Robotics Auton. Syst..

[31]  Stephen L. Chiu,et al.  Task Compatibility of Manipulator Postures , 1988, Int. J. Robotics Res..

[32]  Xavier Pennec,et al.  A Riemannian Framework for Tensor Computing , 2005, International Journal of Computer Vision.

[33]  Bruno Siciliano,et al.  Global task space manipulability ellipsoids for multiple-arm systems , 1991, IEEE Trans. Robotics Autom..

[34]  Darwin G. Caldwell,et al.  Geometry-aware Tracking of Manipulability Ellipsoids , 2018, Robotics: Science and Systems.

[35]  Natalia Dounskaia,et al.  Preferred directions of arm movements are independent of visual perception of spatial directions , 2013, Experimental Brain Research.

[36]  P. Morasso Spatial control of arm movements , 2004, Experimental Brain Research.

[37]  Frank C. Park,et al.  Optimal Robot Design and Differential Geometry , 1995 .

[38]  P. Cisek,et al.  The influence of predicted arm biomechanics on decision making. , 2011, Journal of neurophysiology.

[39]  Dongjun Wu Intrinsic Construction of Lyapunov Functions on Riemannian Manifold , 2020, ArXiv.

[40]  C. Melchiorri,et al.  Robot manipulability , 1995, IEEE Trans. Robotics Autom..

[41]  Pasquale Chiacchio Exploiting Redundancy in Minimum-Time Path Following Robot Control , 1990, 1990 American Control Conference.

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

[43]  Søren Hauberg,et al.  Model Transport: Towards Scalable Transfer Learning on Manifolds , 2014, 2014 IEEE Conference on Computer Vision and Pattern Recognition.

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

[45]  Sylvain Calinon,et al.  Gaussian mixture regression on symmetric positive definite matrices manifolds: Application to wrist motion estimation with sEMG , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[46]  Sukhan Lee,et al.  Dual redundant arm configuration optimization with task-oriented dual arm manipulability , 1989, IEEE Trans. Robotics Autom..

[47]  I. Holopainen Riemannian Geometry , 1927, Nature.

[48]  B. Siciliano,et al.  Reformulation of dynamic manipulability ellipsoid for robotic manipulators , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[49]  Darwin G. Caldwell,et al.  Learning manipulability ellipsoids for task compatibility in robot manipulation , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[50]  Jihong Lee A study on the manipulability measures for robot manipulators , 1997, Proceedings of the 1997 IEEE/RSJ International Conference on Intelligent Robot and Systems. Innovative Robotics for Real-World Applications. IROS '97.

[51]  Gijs Dubbelman,et al.  Intrinsic statistical techniques for robust pose estimation , 2011 .

[52]  Diego Colon,et al.  Some properties of the Riemannian distance function and the position vector X, with applications to the construction of Lyapunov functions , 2010, 49th IEEE Conference on Decision and Control (CDC).