Disturbance observer based robust control for industrial robots with flexible joints

In this paper, a disturbance observer based control algorithm is proposed for industrial robots having flexible joints. The joint flexibility of the robot is modeled as a two mass system. We study on the practical issues for implementing disturbance observer based control scheme in flexible joint robots. For industrial robots, generally the sensors are located on the motor side. If we construct disturbance observer using motor side dynamics, due to the zero dynamics, disturbance observer cannot directly reject the disturbance at the link side. To solve this problem, we propose a dual observer that estimates disturbance and states simultaneously. Using the proposed dual observer, we construct full state feedback controller. The effectiveness of the proposed control scheme for disturbance rejection and robustness is demonstrated by numerical simulation and experiment using HILS (Hardware In the Loop Simulation) system.

[1]  Huei Peng,et al.  Disturbance Observer Based Tracking Control , 2000 .

[2]  Yi Xiong,et al.  Unknown disturbance inputs estimation based on a state functional observer design , 2003, Autom..

[3]  M. Tomizuka,et al.  Design of robustly stable disturbance observers based on closed loop consideration using H/sub /spl infin// optimization and its applications to motion control systems , 2004, Proceedings of the 2004 American Control Conference.

[4]  M. Spong,et al.  Robot Modeling and Control , 2005 .

[6]  Masayoshi Tomizuka,et al.  Suppression of effects of nonlinearities in a class of nonlinear systems by disturbance observers , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[7]  Hyungbo Shim,et al.  State space analysis of disturbance observer and a robust stability condition , 2007, 2007 46th IEEE Conference on Decision and Control.

[8]  Yoichi Hori,et al.  Robust speed control of DC servomotors using modern two degrees-of-freedom controller design , 1991 .

[9]  M. Tomizuka,et al.  Design of Robustly Stable Disturbance Observers Based on Closed Loop Consideration Using H ∞ Optimization and its Applications to Motion Control Systems , 2004 .

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

[11]  Sang-Hun Lee,et al.  A gain scheduling method for the vibration suppression servo controller of articulated robots , 2003 .

[12]  Gene F. Franklin,et al.  Digital control of dynamic systems , 1980 .

[13]  Huei Peng,et al.  Inverse-Dynamics Based State and Disturbance Observers for Linear Time-Invariant Systems , 2002 .

[14]  B. Francis The linear multivariable regulator problem , 1976, 1976 IEEE Conference on Decision and Control including the 15th Symposium on Adaptive Processes.

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