Full-State Tracking Control for Flexible Joint Robots With Singular Perturbation Techniques

This paper proposes a practical method to realize multivariable full-state tracking control for industrial robots with elastic joints. Unlike existing methods, the proposed method does not require high-order derivatives of the link states such as acceleration and jerk. Therefore, the proposed method does not suffer from chatter related to inaccurate estimation of high-order derivatives. The method is derived by adopting a singular perturbation technique. A decoupled error dynamics is achieved by two decoupling control loops: a fast loop that controls the deflection error and a slow loop for tracking control on the link side. Our stability analysis based on a linear system shows that the proposed control system is stable as long as the fast system is at least twice as fast as the slow system. A practical method to select the gain is also presented such that the closed-loop poles are placed at the desired locations. In simulation, we compare the proposed method with feedback linearization. The results indicate that in an ideal scenario the proposed method can obtain a similar performance as feedback linearization. However, the proposed method obtains a superior performance in a realistic scenario. A real-world experiment with a six degree-of-freedom commercial industrial robot is carried out to further validate our approach.

[1]  Svante Gunnarsson,et al.  A Benchmark Problem for Robust Control of a Multivariable Nonlinear Flexible Manipulator , 2008 .

[2]  Alin Albu-Schäffer,et al.  A globally stable state feedback controller for flexible joint robots , 2001, Adv. Robotics.

[3]  Rogelio Lozano,et al.  Adaptive control of robot manipulators with flexible joints , 1992 .

[4]  John J. Craig,et al.  Introduction to Robotics Mechanics and Control , 1986 .

[5]  M. Spong Modeling and Control of Elastic Joint Robots , 1987 .

[6]  P. Tomei A simple PD controller for robots with elastic joints , 1991 .

[7]  Bernard Brogliato,et al.  Experimental Comparison of Nonlinear Controllers for Flexible Joint Manipulators , 1998, Int. J. Robotics Res..

[8]  Svante Gunnarsson,et al.  A Benchmark Problem for Robust Feedback Control of a Flexible Manipulator , 2009, IEEE Transactions on Control Systems Technology.

[9]  B. Brogliato,et al.  Further experimental results on nonlinear control of flexible joint manipulators , 1998, Proceedings of the 1998 American Control Conference. ACC (IEEE Cat. No.98CH36207).

[10]  Peter N. Nikiforuk,et al.  A manoeuvre control strategy for flexible-joint manipulators with joint dry friction , 2009, Robotica.

[11]  Alessandro De Luca,et al.  An Acceleration-based State Observer for Robot Manipulators with Elastic Joints , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[12]  Petar V. Kokotovic,et al.  An integral manifold approach to the feedback control of flexible joint robots , 1987, IEEE J. Robotics Autom..

[13]  Zhaoheng Liu,et al.  Characterization, modeling and vibration control of a flexible joint for a robotic system , 2014 .

[14]  A. De Luca Feedforward/feedback laws for the control of flexible robots , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[15]  G. W. Irwin,et al.  Tracking control of manipulators with elastic joints , 1993, Proceedings of IEEE International Conference on Control and Applications.

[16]  John J. Craig Zhu,et al.  Introduction to robotics mechanics and control , 1991 .

[17]  Christopher G. Atkeson,et al.  Experimental evaluation of feedforward and computed torque control , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[18]  Sung-Rak Kim,et al.  A practical approach for minimum-time trajectory planning for industrial robots , 2010, Ind. Robot.

[19]  Mrdjan Jankovic,et al.  Observer based control for elastic joint robots , 1995, IEEE Trans. Robotics Autom..

[20]  Rogelio Lozano,et al.  Global tracking controllers for flexible-joint manipulators: a comparative study , 1995, Autom..

[21]  Jean-Jacques E. Slotine,et al.  Adaptive manipulator control: A case study , 1988 .

[22]  Jing Yuan,et al.  Composite adaptive control of flexible joint robots , 1993, Autom..

[23]  Stig Moberg,et al.  On Feedback Linearization for Robust Tracking Control of Flexible Joint Robots , 2008 .

[24]  John Y. Hung Control of industrial robots that have transmission elasticity , 1990, [Proceedings] IECON '90: 16th Annual Conference of IEEE Industrial Electronics Society.

[25]  M. C. Readman,et al.  Stabilization of the Fast Modes of a Flexible-Joint Robot , 1992 .

[26]  P. S. Gandhi *,et al.  High-speed precision tracking with harmonic drive systems using integral manifold control design , 2005 .

[27]  M. Spong,et al.  Integral manifolds of singularly perturbed systems with application to rigid-link flexible-joint multibody systems , 2000 .

[28]  Hamid D. Taghirad,et al.  Stability analysis and robust composite controller synthesis for flexible joint robots , 2006, Adv. Robotics.

[29]  Alessandro De Luca,et al.  A general algorithm for dynamic feedback linearization of robots with elastic joints , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[30]  Mikael Norrlöf,et al.  A New Concept for Motion Control of Industrial Robots , 2008 .

[31]  Kiyoshi Ohishi,et al.  High Speed Motion Control Method of Industrial Robot Based on Dynamic Torque Compensation and Two-Degrees-of-Freedom Control System , 2003 .

[32]  P. Kokotovic,et al.  A Slow Manifold Approach to Feedback Control of Nonlinear Flexible Systems , 1985, 1985 American Control Conference.

[33]  Gianluca Antonelli,et al.  SmartMove4: an industrial implementation of trajectory planning for robots , 2007, Ind. Robot.

[34]  Stig Moberg,et al.  Modeling and Control of Flexible Manipulators , 2007 .

[35]  Malcolm Good,et al.  Re-definition of the robot motion control problem: Effects of plant dynamics, drive system constraints, and user requirements , 1984, The 23rd IEEE Conference on Decision and Control.