유연한 수평 다관절형 로봇의 진동제어

Vibration control of a flexible SCARA type robot

This paper concerns a SCARA type robot with the second arm flexible. Its equations of motion are derived by the Lagrangian mechanics. For controller design, the perturbation approach is taken to separate the original equations of motion into linear equations describing small perturbed motions and nonlinear equations describing purely rigid motion of the robot. To effect the desired payload motion, open loop control inputs are first determined based on the inverse dynamics of the latter. Next, in order to reduce the positional error during maneuver, an active vibration suppression is done. To this end, a feedback control is designed for robustness against disturbance on the basis of the linear equations and the LQR theory modified with a prescribed degree of stability. The numerical simulations results show the satisfactory control performance.