Motor controller for tandem control
AssigneeFanuc Corporation
InventorsKazuomi Maeda, Yukio Toyozawa, Yasusuke Iwashita
Life of this patent
Estimating the term…
Abstract
In position tandem control in which one movable member is driven by two motors, an output of the integral element of the velocity control unit in the control system for one motor is copied to the integral element of the velocity control unit in the control system for the other motor. A preload is added to a torque command output from each of the velocity control units in the motor control systems for two motors so that torques in mutually opposite directions are generated to suppress backlash between gears.
Claims2
A motor controller having two motors for driving one driven body, a position detector for detecting a position of the driven body, and a velocity detector for detecting a velocity of the driven body or the motor, the motor controller comprising:
- a control system, for each of the two motors, that includes
- a position control unit that computes a velocity command value, based on a position deviation value which is a difference between an identical position command value input from a host controller and a position feedback value fed back from the position detector, and outputs the computed velocity command value,
- a velocity control unit that receives the velocity command value output from the position control unit, computes a torque command based on the velocity command value thus received and a velocity feedback value fed back from the velocity detector by using an integral element and a proportional element, and outputs the computed torque command value, and
- a current control unit that controls a motor driving current based on the torque command value output from the velocity control unit;
- a means for making an output value of the integral element of the velocity control unit in the control system for one of the two motors identical to an output value of the integral element of the velocity control unit in the control system for another of the two motors;
- and
- a compensation unit that adds a preload torque value to each of the torque command values output from the velocity control units in the control systems for the two motors in order to suppress backlash between the two motors, wherein the compensation unit has a time constant circuit, allowing the preload torque value to be added to gradually increase based on a prescribed time constant.
Dependencies are inferred from the claim text.