Robot control apparatus
AssigneeFanuc Corporation
InventorsMitsuo Kurakake, Keiji Sakamoto, Takashi Iwamoto
Life of this patent
Estimating the term…
Abstract
In a robot control apparatus, the results of processing regarding inertia terms of a motion equation are stored in accordance with the position of a robot arm. The computation period of the inertia terms can be set to be larger than a drive torque computation period. The robot is controlled with the same precision and, moreover, drive torque can be computed at a shorter computation time.
Claims7
A robot control apparatus for computing, on-line, a torque command of a robot arm based on a motion equation of a manipulator, and for servo-controlling each drive means, comprising:
- a servomotor, coupled to the manipulator, for driving the manipulator through the intermediary of the robot arm;
- arithmetic means for computing drive torque of the servomotor in accordance with the motion equation;
- memory means for executing a computation, with regard to an inertia term included in the motion equation, at a predetermined period greater than a drive torque computation period in dependence upon the position of the robot arm, and for sequentially updating and storing the results of this computation;
- and
- control means for applying the drive torque to the servomotor and performing feed-forward compensation of the servomotor based on the motion equation.
A robot control apparatus for a robot having a robot arm with a robot hand attached to the robot arm, comprising:
- a servomotor for driving the robot hand and the robot arm;
- inputting means for inputting workpiece signals for identifying a plurality of workpieces;
- sensing means for providing a sensing signal corresponding to a workpiece held by the robot hand;
- processing means, coupled to said input means and said sensing means, for determining an inertia term included in a motion equation based on the workpiece signals and the sensing signal, said processing means computing drive torque of the servomotor in accordance with the motion equation, the inertia term being computed at a predetermined period greater than a period for computing the drive torque;
- and
- control means, coupled to said processing means and said servomotor, for performing feed-forward compensation of the servomotor based on the motion equation.
A method for controlling a robot having a robot arm with a robot hand attached to the robot arm, comprising the steps of:
- (a) inputting workpiece signals for identifying a plurality of workpieces;
- (b) generating a sensing signal corresponding to a workpiece held by the robot hand;
- (c) determining an inertia term included in a motion equation based on the weight of each workpiece and the sensing signal;
- (d) computing drive torque of a servomotor for driving the robot hand and the robot arm, in accordance with the motion equation, the inertia term being computed at a predetermined period greater than a period for computing the drive torque;
- and
- (e) performing feed-forward compensation of the servomotor based on the motion equation to cause the servomotor to drive the robot hand and the robot arm.
A robot control apparatus for a robot having a robot arm with a robot hand attached to the robot arm, comprising:
- an input unit for inputting weights of various workpieces;
- memory means, for receiving the weights of the workpieces from said input unit, calculating drive torque and coefficients of non-linear terms on the basis of the weight of each workpiece, and storing the coefficients as inertia terms corresponding to the workpiece weight and robot arm position, the period for calculating said inertia terms being larger than a period for calculating said drive torque;
- a sensor, coupled to said memory means, for inputting a signal to said memory means indicating that a workpiece has been gripped;
- servo-control means for receiving control signals corresponding to said inertia terms from said memory means;
- a servomotor, coupled to said servo-control means, for receiving said drive torque and providing drive along each axis of the robot;
- and
- arithmetic means for detecting a rotational angle of said servomotor and for detecting a rotational speed of said servomotor, the rotational angle and the rotational speed of said servomotor being input to said servo-control means for providing drive torque compensation to said servomotor.
Dependencies are inferred from the claim text.