Controller for a drive mechanism driven by a plurality of motors
AssigneeFanuc Corporation
InventorKazunori Iijima
Life of this patent
Estimating the term…
Abstract
A controller of the present invention for a drive mechanism which is driven by a plurality of motors includes a position command calculation unit and a torque command calculation unit, the position command calculation unit delivers a common position command value to each of the motors and the torque command calculation unit switches, according to the operation state of the drive mechanism, between individualization control for individually performing the output of an integral element of the torque command calculation unit to each of the motors and sharing control for sharing the output of the integral element of the torque command calculation unit to the motors.
Claims3
A controller for a drive mechanism which is driven by a plurality of motors, the controller comprising, according to the motors:
- a position command calculation unit which calculates a position command value for driving the drive mechanism;
- a position detection unit which detects a position of the motor;
- a speed command calculation unit which calculates a speed command value based on a position error value determined from the position command value calculated by the position command calculation unit and a position detection value detected by the position detection unit;
- a speed detection unit which calculates a speed detection value from the position detection value detected by the position detection unit;
- and
- a torque command calculation unit which calculates a torque command value from a speed error value determined from the speed command value calculated by the speed command calculation unit and the speed detection value detected by the speed detection unit by use of at least an integral element,
- wherein the position command calculation unit delivers the common position command value to each of the motors,
- the torque command calculation unit switches, according to an operation state of the drive mechanism, between individualized control so that the output of the integral element of the torque command calculation unit is individualized to each of the plurality of motors and sharing control so that the output of the integral element of the torque command calculation unit is shared between the plurality of motors, and
- wherein when the position command calculation unit feeds the position command value which is specified as a stop or constant speed operation, the operation state is determined to be a steady state such that the sharing control is performed.
Dependencies are inferred from the claim text.