Disturbance observer based path tracking control of robot manipulator considering torque saturation

In this paper, a path tracking algorithm is proposed to compensate path deviation due to torque bound. For this, a disturbance observer is applied to each joint of an n degrees of freedom manipulator to obtain a simple equivalent robot dynamics (SERD) being represented as an n independent double integrator system. For an arbitrary trajectory generated for a given path in Cartesian space, whenever the saturation of any actuators is met, the desired acceleration of the nominal trajectory in Cartesian space is modified online by using SERD. Also an integral action with respect to the difference between the nominal and the modified trajectories is utilized in nonsaturated region of actuators to reduce the path error. To verify the effectiveness of the proposed algorithms, numerical simulations and real experiments are performed for two degrees of freedom SCARA type direct-drive arm.

[1]  Kang G. Shin,et al.  Minimum-time control of robotic manipulators with geometric path constraints , 1985 .

[2]  J. Bobrow,et al.  Time-Optimal Control of Robotic Manipulators Along Specified Paths , 1985 .

[3]  T.A. Lasky,et al.  Robust independent robot joint control: design and experimentation , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[4]  L. Nielsen,et al.  Torque limited path following by on-line trajectory time scaling , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

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

[6]  Bruce A. Francis,et al.  Feedback Control Theory , 1992 .

[7]  Susumu Tachi,et al.  Path Tracking Control Of A Manipulator Considering Torque Saturation , 1992, Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Kiyoshi Ohishi,et al.  Robust manipulator control method considering limit values of torque and controller output , 1996, Proceedings of the 1996 IEEE IECON. 22nd International Conference on Industrial Electronics, Control, and Instrumentation.

[9]  權寧住,et al.  Mechatronics , 2019, CIRP Encyclopedia of Production Engineering.