Servomotor control method
AssigneeToshiba Kikai Kabushiki Kaisha
InventorsMinoru Hamamura, Sadaji Hayama, Jun Fujita
Life of this patent
Estimating the term…
Abstract
The position of a movable body driven for circular interpolation movement by servomotors is measured directly or indirectly, and the servomotors are controlled in a feedback control mode to drive the movable body for movement according to a position command signal. A torque signal at quadrant change in which the direction of movement of the movable body changes, and a maximum or minimum torque signal at a moment immediately after the reversion of the servomotor are detected, a reference torque for correction is determined on the basis of the difference between the torque signal value at quadrant change and the maximum or minimum torque command value, and the torque signal at quadrant change is corrected with reference to the reference torque.
Claims6
A method for controlling a servomotor to drive a movable body for a circular interpolation feed motion, while measuring a position of the movable body directly or indirectly to provide a feedback signal, said method comprising:
- detecting a torque signal sent to the servomotor approximately at quadrant change when the moving direction of the movable body changes, and detecting a maximum or minimum torque signal sent to the servomotor at a moment immediately after reversion of the servomotor;
- determining a reference torque for correction on the basis of a difference between the torque signal detected approximately at quadrant change and the maximum or minimum torque signal detected at a moment immediately after the reversion of the servomotor;
- and
- correcting the torque signal to be delivered to the servomotor at quadrant change on the basis of the reference torque.
A method for controlling a servomotor to drive a movable body for a circular interpolation feed motion, while measuring a position of the movable body directly or indirectly to provide a feedback signal, said method comprising:
- executing a test program which specifies a given radius of a circular path and a given feed rate and makes the movable body move for a test circular interpolation feed motion;
- detecting a torque signal sent to the servomotor approximately at quadrant change when the direction of motion of the movable body changes, and detecting a maximum or minimum torque signal sent to the servomotor at a moment immediately after reversion of the servomotor;
- determining a reference torque for the radius and the feed rate on the basis of a difference between the torque signal detected approximately at quadrant change and the maximum or minimum torque signal detected at a moment immediately after reversion of the servomotor;
- producing a correction torque table tabulating reference torques for correction corresponding to sets of radii of circular paths and feed rates by repeating the test program for different radii and different feed rates;
- and
- correcting the torque signal to be delivered to the servomotor approximately at quadrant change on the basis of a reference torque read from the correction torque table during execution of a numerical control program.
Dependencies are inferred from the claim text.