On-line joint limit avoidance for torque controlled robots by joint space parametrization

This paper proposes control laws ensuring the stabilization of a time-varying desired joint trajectory and joint limit avoidance in the case of fully-actuated manipulators. The key idea is to perform a parametrization of the feasible joint space in terms of exogenous states. It follows that the control of these states allows for joint limit avoidance. One of the main outcomes of this paper is that position terms in control laws are replaced by parametrized terms. Stability and convergence of time-varying reference trajectories obtained with the proposed method are demonstrated to be in the sense of Lyapunov. The introduced control laws are verified by carrying out experiments on two degrees-of-freedom of the torque-controlled humanoid robot iCub.

[1]  Francis Eng Hock Tay,et al.  Barrier Lyapunov Functions for the control of output-constrained nonlinear systems , 2009, Autom..

[2]  Olivier Kermorgant,et al.  Avoiding joint limits with a low-level fusion scheme , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Andrew Howard,et al.  Design and use paradigms for Gazebo, an open-source multi-robot simulator , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[4]  Yogendra P. Kakad,et al.  Contact force measurement noise in the partial feedback linearization control of humanoid robots , 2010, 2010 10th IEEE-RAS International Conference on Humanoid Robots.

[5]  Bin Yang,et al.  Improved Damped Least Squares Solution with Joint Limits, Joint Weights and Comfortable Criteria for Controlling Human-like Figures , 2008, 2008 IEEE Conference on Robotics, Automation and Mechatronics.

[6]  P. Olver.  Nonlinear Systems , 2013 .

[7]  Giulio Sandini,et al.  Exploiting proximal F/T measurements for the iCub active compliance , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Masaaki Shibata,et al.  Maximal admission of joint range of motion based on redundancy resolution for kinematically redundant manipulators , 2010, Proceedings of SICE Annual Conference 2010.

[9]  Jun Wang,et al.  A dual neural network for redundancy resolution of kinematically redundant manipulators subject to joint limits and joint velocity limits , 2003, IEEE Trans. Neural Networks.

[10]  Shuzhi Sam Ge,et al.  A unified quadratic-programming-based dynamical system approach to joint torque optimization of physically constrained redundant manipulators , 2004, IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics).

[11]  Christopher G. Atkeson,et al.  Optimization based full body control for the atlas robot , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[12]  Ali Jadbabaie,et al.  Safety Verification of Hybrid Systems Using Barrier Certificates , 2004, HSCC.

[13]  Frank Allgöwer,et al.  CONSTRUCTIVE SAFETY USING CONTROL BARRIER FUNCTIONS , 2007 .

[14]  A. Liegeois,et al.  Automatic supervisory control of the configuration and behavior of multi-body mechanisms , 1977 .

[15]  Giulio Sandini,et al.  Force feedback exploiting tactile and proximal force/torque sensing , 2012, Autonomous Robots.

[16]  Alexander Herzog,et al.  Balancing experiments on a torque-controlled humanoid with hierarchical inverse dynamics , 2013, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Gabriele Nava,et al.  Stability analysis and design of momentum-based controllers for humanoid robots , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[18]  Robert E. Mahony,et al.  Bounded torque control for robot manipulators subject to joint velocity constraints , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[19]  Jing-Sin Liu,et al.  Avoidance of obstacles and joint limits for end-effector tracking in redundant manipulators , 2002, 7th International Conference on Control, Automation, Robotics and Vision, 2002. ICARCV 2002..

[20]  Masayuki Inaba,et al.  Hand-centered whole-body motion control for a humanoid robot , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[21]  G. Oriolo,et al.  Robotics: Modelling, Planning and Control , 2008 .

[22]  Yuval Tassa,et al.  Control-limited differential dynamic programming , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Stefan Schaal,et al.  Full dynamics LQR control of a humanoid robot: An experimental study on balancing and squatting , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[24]  Giulio Sandini,et al.  The iCub humanoid robot: an open platform for research in embodied cognition , 2008, PerMIS.

[25]  Dennis W. Hong,et al.  Compliant locomotion using whole-body control and Divergent Component of Motion tracking , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[26]  Atsuo Takanishi,et al.  Online learning of humanoid robot kinematics under switching tools contexts , 2013, 2013 IEEE International Conference on Robotics and Automation.

[27]  A. De Luca,et al.  Fast redundancy resolution for high-dimensional robots executing prioritized tasks under hard bounds in the joint space , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Tobias Faust.  Robot Analysis And Control , 2016 .

[29]  Jean-Jacques E. Slotine,et al.  Robot analysis and control , 1988, Autom..

[30]  Alin Albu-Schäffer,et al.  Dynamic whole-body mobile manipulation with a torque controlled humanoid robot via impedance control laws , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  Nikos G. Tsagarakis,et al.  An attractor-based Whole-Body Motion Control (WBMC) system for humanoid robots , 2013, 2013 13th IEEE-RAS International Conference on Humanoid Robots (Humanoids).

[32]  François Chaumette,et al.  New strategies for avoiding robot joint limits: Application to visual servoing using a large projection operator , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  Rajiv V. Dubey,et al.  A weighted least-norm solution based scheme for avoiding joint limits for redundant joint manipulators , 1993, IEEE Trans. Robotics Autom..

[34]  Ren C. Luo,et al.  Cartesian position and force control with adaptive impedance/compliance capabilities for a humanoid robot arm , 2013, 2013 IEEE International Conference on Robotics and Automation.

[35]  Li Chen,et al.  Hierarchical Nonholonomic Path Planning of Dual-Arm Space Robot Systems with Joint Limits , 2006, 2006 6th World Congress on Intelligent Control and Automation.

[36]  Kiyotaka Izumi,et al.  Neural network learning from hint for the inverse kinematics problem of redundant arm subject to joint limits , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.