Geometry-aware Tracking of Manipulability Ellipsoids

Body posture can greatly influence human performance when carrying out manipulation tasks. Adopting an appropriate pose helps us regulate our motion and strengthen our capability to achieve a given task. This effect is also observed in robotic manipulation where the robot joint configuration affects not only the ability to move freely in all directions in the workspace, but also the capability to generate forces along different axes. In this context, manipulability ellipsoids arise as a powerful descriptor to analyze, control and design the robot dexterity as a function of the articulatory joint configuration. This paper presents a new tracking control scheme in which the robot is requested to follow a desired profile of manipulability ellipsoids, either as its main task or as a secondary objective. The proposed formulation exploits tensor-based representations and takes into account that manipulability ellipsoids lie on the manifold of symmetric positive definite matrices. The proposed mathematical development is compatible with statistical methods providing 4th-order covariances, which are here exploited to reflect the tracking precision required by the task. Extensive evaluations in simulation and two experiments with a real redundant manipulator validate the feasibility of the approach, and show that this control formulation outperforms previously proposed approaches.

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

[2]  E. Kraft,et al.  A quaternion-based unscented Kalman filter for orientation tracking , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.

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

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

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

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

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

[8]  Tsuneo Yoshikawa,et al.  Dynamic Manipulability of Robot Manipulators , 1985 .

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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