Vibration Suppression of a Flexible-Joint Robot Based on Parameter Identification and Fuzzy PID Control

摘要

In order to eliminate the influence of the joint torsional vibration on the system operation accuracy, the parameter identification and the elastic torsional vibration control of a flexible-joint robot are studied. Firstly, the flexible-joint robot system is equivalent to a rotor dynamic system, in which the mass block and the torsion spring are used to simulate the system inertia link and elasticity link, for establishing the system dynamic model, and the experimental prototype is constructed. Then, based on the mechanism method, the global electromechanical-coupling dynamic model of the flexible-joint robot system is constructed to clear and define the mapping relationship between the driving voltage of the DC motor and the rotational speed of joint I and joint II. Furthermore, in view of the contradiction between the system response speed and the system overshoot in the vibration suppression effect of the conventional PID controller, a fuzzy PID controller, whose parameters are determined by the different requirements in the vibration control process, is designed to adjust the driving voltage of the DC motor for attenuating the system torsional vibration. Finally, simulation and control experiments are carried out and the results show that the designed fuzzy PID controller can effectively suppress the elastic torsional vibration of the flexible-joint robot system with synchronization optimization of control accuracy and dynamic quality.