Method of controlling a servomotor
AssigneeFanuc Corporation
InventorTetsuaki Kato
Life of this patent
Estimating the term…
Abstract
A servomotor control method utilizing conventional linear control techniques, which permits easy introduction of sliding mode control. The phase surface of the sliding mode is made to be equivalent to a mode of obtaining a torque command by a conventional linear control, and a switching input (.tau.1) is added to the torque command (.tau.0) obtained by the linear control, thereby further obtaining a corrected torque command (.tau.). The switching input (.tau.1) is determined in accordance with the positive or negative sign of the torque command (.tau.0) and the signs of various values such as a position deviation (.epsilon.), a speed loop integral, etc., which are obtained during the calculation of the torque command (.tau.0).
Claims3
A method of controlling a servomotor in a sliding mode, comprising the steps of:
- obtaining a torque command (.tau.0) for carrying out a proportional control for a position loop and a proportional-plus-integral control for a speed loop;
- setting a phase surface of the sliding mode to be in proportion to the torque command (.tau.0) obtained by a position loop processing according to the proportional control and a speed loop processing according to the proportional-plus-integral control;
- providing individual gains for a switching input (.tau.1) which are set based on the following relationship:
- Kp<(K2/Jmax)-(K1/K2)
- where Kp is a position gain of the position loop, K1 is an integral gain of the speed loop, K2 is a proportional gain of the speed loop, and Jmax is a maximum inertia of a controlled system, so that the derivative of a Liapunov function is always negative, and is determined in accordance with signs of respective values of the torque command (.tau.0), a position deviation (.epsilon.), an integral (I) of the position deviation and a speed deviation, acceleration (.theta.d) of a move command, and speed feedback (.theta.), which are obtained by the position loop process according to the proportional control and the speed loop process according to the proportional-plus-integral control;
- adding the switching input (.tau.1) to the torque command (.tau.0) to obtain a corrected torque command (.tau.);
- and
- driving the servomotor in accordance with the corrected torque command (.tau.).
A method of controlling a servomotor in a sliding mode, comprising the steps of:
- obtaining a torque command (.tau.0) for carrying out a proportional control for a position loop and a proportional-plus-integral control for a speed loop;
- setting a phase surface of the sliding mode to be in proportion to the torque command (.tau.0) obtained by a position loop processing according to the proportional control and a speed loop processing according to the proportional-plus-integral control;
- providing individual gains for a switching input (.tau.1) which are set based on the following relationship;
- Kp<(K2/Jmax)-(K1/K2)
- where Kp is a position gain of the position loop, K1 is an integral gain of the speed loop, K2 is a proportional gain of the speed loop, and Jmax is a maximum inertia of a controlled system, and is given as a value which is a combination of an absolute value of a maximum torque (.tau.max) that the servomotor can output, and a positive or negative sign identical with that of the torque command (.tau.0), which is obtained by the position loop process according to the proportional control and the speed loop process according to the proportional-plus-integral control;
- adding the switching input (.tau.1) to the torque command (.tau.0) to obtain a corrected torque command (.tau.);
- and
- driving the servomotor in accordance with the corrected torque command (.tau.).
Dependencies are inferred from the claim text.