Controller for a plurality of motors based on provided torque
AssigneeFanuc Corporation
InventorKazunori Iijima
Life of this patent
Estimating the term…
Abstract
In a controller of the present invention that controls a drive mechanism driven by a plurality of motors, when a state where the output of the motors is zero shifts to a state where the output is non-zero such that a preload torque is provided by a preload torque superimposition unit, at least one of the motors forms a contact portion between the drive mechanism and the motor by speed control based on a speed detection value detected in a speed detection unit, and in a state where the contact portion is formed, the preload torque is provided by the preload torque superimposition unit.
Claims2
A controller for a drive mechanism which is driven by a plurality of motors, the controller comprising:
- 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 each of the motors;
- 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;
- 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;
- and
- a preload torque superimposition unit which superimposes a set preload torque on the torque command value,
- wherein, when a shift occurs from a state where an output of the motors is zero to a state where the output is non-zero such that the preload torque is provided by the preload torque superimposition unit, at least one of the motors forms a contact portion between the drive mechanism and the motor by speed control based on the speed detection value detected in the speed detection unit such that the preload torque is provided, and
- wherein, when a shift occurs from the state where the output of the motors is zero to the state where the output is non-zero such that the preload torque is provided by the preload torque superimposition unit, position control is performed on at least one of the motors based on the position detection value detected in the position detection unit and the speed control is performed on at least one of the motors so as to form the contact portion, and in a state where the contact portion is formed, the preload torque is provided by the preload torque superimposition unit.
Dependencies are inferred from the claim text.