US 5,811,952 AGranted

Method of setting accelerating/decelerating motion of robot

AssigneeFanuc Corporation

InventorsTetsuaki Kato, Atsuo Nagayama

Life of this patent

Estimating the term…

Loading patent…

Abstract

A method of setting an accelerating/decelerating motion of a robot, in which a torque of the robot can be used efficiently without being saturated. In one section of motion, a moving ratio r representing a position which satisfies a condition such that a maximum torque is generated at a position where the maximum torque is needed, is successively and approximately obtained. First, a 0-th approximate solution (initial value) is assumed as .sub.i r.sub.0 =0, and then equations of motion are calculated at the position .sub.i r.sub.0 to obtain an acceleration so as to generate the maximum torque. The position such that the torque becomes maximal when the calculated acceleration is used is obtained as .sub.i r.sub.k+1. The difference .vertline..sub.i r.sub.k+1 -.sub.i r.sub.k .vertline. between the calculated .sub.i r.sub.k+1 and the previously calculated .sub.i r.sub.k is calculated, and it is checked whether or not the difference exceeds a preset very small value .epsilon.. If yes, the processing returns to S3. If no, it is determined and stored as .sub.i rsol=.sub.i r.sub.k+1, the index i is increased by 1 and k is cleared as k=0. If calculation for all the axes has not completed, the processing returns S1. Upon completion of calculation for all the axes, the processing proceeds to S7. In S7, the maximum of .sub.i rsol is defined as rsol, an acceleration in accordance with rsol is obtained for each axis, and a condition for the accelerating motion of each axis is set.

Claims2

Dependent claims

A method of setting an accelerating/decelerating motion of a robot, based on a constraint condition for each of robot axes to realize a target track of the robot when defining a track plan in a control device of the robot, motion equations of the robot and a sequential computing process considering the constraint condition relating to a maximum torque of each robot axis, said sequential computing process comprising the steps of:

(a) setting a position on the target track and calculating an acceleration so as to generate the maximum torque, based on equations of motion of the robot;
(b) calculating a position of maximum command torque in which a command torque becomes maximal when the robot is moved on the target track at said acceleration;
(c) calculating a torque including an interference torque, based on the position of maximum command torque, a speed and the acceleration at that time, using the equations of motion of the robot;
(d) discriminating whether or not the calculated torque substantially satisfies the constraint condition with respect to the maximum torque of each axis;
(e) updating the acceleration so as to satisfy the constraint condition and returning to said step (b) when it is discriminated that the constraint condition is substantially not satisfied in said step (d);
and
(f) defining the acceleration when it is discriminated that the constraint condition is substantially satisfied in said step (d) for the acceleration for the accelerating/decelerating motion and setting the accelerating/decelerating motion for the robot based on the defined acceleration;
said steps (b) through (e) being repeatedly executed until it is discriminated that the constraint condition is substantially satisfied in said step (d).

5 more elements

Dependencies are inferred from the claim text.

Facts

Application: 08/793,584Filed 28 Feb 1997
Priority: JP 7-18500029 Jun 1995
Granted: 22 Sep 1998
Term ends: Not estimatedThe source records don’t support an estimate.

Classification5 codes

G05B 19/416
Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to…
G05B 2219/40453
Robotics, robotics mapping to robotics vision: maximum torque for each axis
G05B 2219/40523
Robotics, robotics mapping to robotics vision: path motion planning, path in space followed by tip of robot
G05B 2219/43069
Speed, acceleration, deceleration control ADC: measure acceleration, derive limit torque, adapt acceleration