Vibration control method
AssigneeFanuc Corporation
InventorsTetsuaki Kato, Soichi Arita
Life of this patent
Estimating the term…
Loading patent…
AssigneeFanuc Corporation
InventorsTetsuaki Kato, Soichi Arita
Estimating the term…
A control method capable of preventing vibration of a control object and making a band sufficiently high in controlling a robot or a machine tool in semi-closed loop. A torque command u" is obtained by executing a feedback-control of the servomotor using the position and speed of a servomotor in the same manner as in the conventional method. A displacement amount d1 between the motor position and the position of the control object and a displacement speed d2 are estimated by an observer. A corrected torque command u is determined by subtracting, from the torque command u", values obtained by multiplying the displacement amount d1 and the displacement speed d2 by the adjustable gains (.alpha.-KpK1) and (.beta.-K1), respectively. The servomotor is driven based on the corrected torque command u thus obtained. There can be obtained effects equivalent to those that would be obtained when a feedback-control is performed using the position and speed of the control object. The adjustment values .alpha. and .beta. are so adjusted as to stabilize a response from the corrected torque command to the control object.
A vibration control method for controlling a position and a speed of a control object by controlling a position and a speed of a servomotor, comprising the steps of:
Dependencies are inferred from the claim text.