Method for controlling an articulated robot

A method for controlling an articulated robot of the type which comprises a first arm supported rotatably from a main body via a first articulated joint, a second arm supported rotatably from said first arm via a second articulated joint, and respective first and second motors coupled to said first and second articulated joints for rotating said first arm and said second arm, each of said first and second motors having a respective predetermined upper torque limit, wherein the displacement of said first arm and said second arm to displace the remote end of said second arm from an initial position P.sub.i to a subsequent position P.sub.i+1 is controlled by angular velocity instructions provided to said first and second motors to effect controlled acceleration and deceleration during displacement from the initial position P.sub.i to the subsequent position P.sub.i+1, said method comprising the steps of:

• storing a reference acceleration curve and a reference deceleration curve in a memory device by which velocity instruction values or desired displacement positional instruction values are generated as a function of time or a displacement amount;
• storing discrete values of factors which affect torque load of said first and second motors as a function of positional data for a displacement starting point and a displacement ending point;
• calculating combination-values for all combinations of said discrete value parameters for acceleration times or the displacement amounts during acceleration, the deceleration times or the displacement amounts during deceleration which combination-values make said load torques of said first motor and said second motor below their respective predetermined upper torque limit and the torque load for at least one of said first and second motors at a maximum value under its predetermined upper torque limit;
• memorizing the calculated combination-values in a memory device corresponding to said combinations of said discrete value parameters;
• reading in positional data for an initial position P.sub.i and a subsequent position P.sub.i+1 ;
• calculating factors used for said discrete value parameters from positional data for the initial position P.sub.i and a subsequent position P.sub.i+1 ;
• comparing said factors calculated value with said stored discrete value parameters and obtaining the acceleration time or the displacement amount during acceleration and the deceleration time or the displacement amount during deceleration, which correspond to the nearest discrete value parameters;
• using said acceleration time or said displacement amount during said acceleration obtained by said comparing step as a reference value for said reference acceleration curve and issuing velocity instruction values or a desired displacement positional instruction during acceleration;
• and
• using said deceleration time or said displacement amount during deceleration obtained by said comparing step as a reference for said reference deceleration curve and issuing velocity instructions value or a desired transfer positional instruction in the deceleration.

A method for controlling an articulated robot of the type which comprises a first arm supported rotatably from a main body via a first articulated joint, a second arm supported rotatably from said first arm via a second articulated joint, a first motor and a first speed reducer coupled to said first articulated joint and a second motor and second speed reducer connected to said second articulated joint for rotating said first arm and said second arm, said first motor and first speed reducer and said second motor and second speed reducer having respective predetermined upper torque limits, wherein the displacement of said first arm and said second arm to displace the remote end of said second arm from an initial position P.sub.i to a subsequent position P.sub.i+1 is controlled by angular velocity instructions provided to said first and second motors to effect controlled acceleration and deceleration during displacement from the initial position P.sub.i to the subsequent position P.sub.i+1, said method comprising the steps of:

• (a) storing a reference acceleration curve and a reference deceleration curve in a memory means by which velocity instruction values or desired displacement positional instruction values for said respective first and second motors are generated as a function of time or a displacement amount;
• (b) reading in positional data for the initial position P.sub.i and the subsequent position P.sub.i+1 to which the remote end of the second arm is to be displaced;
• (c) varying an acceleration time or a displacement amount to obtain an acceleration value as a function of said stored reference curve information for acceleration of the remote end of said second arm from position P.sub.i to position P.sub.i+1 ;
• (d) calculating the torque load of said first motor and said first speed reducer and said second motor and said second speed reducer for acceleration of the remote end of said second arm from said initial position P.sub.i to said subsequent position P.sub.i+1 for the obtained acceleration value;
• (e) repeating said varying step (c) and calculating step (d) until the calculated torque load for each of said first motor and first speed reducer and said second motor and second speed reducer is below their respective predetermined upper torque limit and the calculated torque load for at least one of said first motor and first speed reducer said second motor and second speed reducer is at a maximum value under its predetermined upper torque limit;
• (f) varying a deceleration time or a displacement amount to obtain an deceleration value as a function of said stored reference curve information for deceleration of the remote end of said second arm from position P.sub.i to position P.sub.i+1 ;
• (g) calculating the torque load of said first motor and said first speed reducer and said second motor and speed reducer for deceleration of the remote end of said second arm from said initial position P.sub.i to said subsequent position P.sub.i+1 for the obtained deceleration value;
• (h) repeating said varying step (f) and calculating step (g) until the calculated torque load for each of said first motor and first speed reducer and said second motor and second speed reducer is below their respective predetermined upper torque limit and the calculated torque load for at least one of said first motor and speed reducer and said second motor and second speed reducer is at a maximum value under its predetermined upper torque limit;
• (i) using said obtained acceleration time or said displacement amount during acceleration as a reference for said stored reference acceleration curve and issuing a velocity instruction value or a desired displacement positional instruction for the acceleration portion of the displacement of the remote end of said second arm;
• and
• (j) using said obtained deceleration time or said displacement amount during deceleration as a reference of said reference deceleration curve and issuing a velocity instruction value or desired displacement positional instruction for the deceleration portion of the displacement of the remote end of said second arm.

A method for controlling an articulated robot of the type which comprises a first arm supported rotatably from a main body via a first articulated joint, a second arm supported rotatably from said first arm via a second articulated joint, a first motor and a first speed reducer coupled to said first articulated joint and a second motor and second speed reducer connected to said second articulated joint for rotating said first arm and said second arm, said first motor and first speed reducer and said second motor and second speed reducer having respective predetermined upper torque limits, wherein the displacement of said first arm and said second arm to displace the remote end of said second arm from an initial position P.sub.i to a subsequent position P.sub.i+1 is controlled by angular velocity instructions provided to said first and second motors to effect controlled acceleration and deceleration during displacement from the initial position P.sub.i to the subsequent position P.sub.i+1, said method comprising the steps of:

• storing a reference acceleration curve and a reference deceleration curve in a memory device by which velocity instruction values or desired displacement positional instruction values are generated as a function of time or a displacement amount;
• storing discrete values of factors which affect torque load of said first motor and first speed reducer and said second motor second speed reducer as a function of positional data for a displacement starting point and a displacement ending point;
• calculating combination-values for all combinations of said discrete value parameters for acceleration times or the displacement amounts during acceleration and the deceleration times or the displacement amounts during deceleration which combination-values make said load torques of said first motor and first speed reducer and said second motor and second speed reducer below their respective predetermined upper torque limit and the torque load for at least one of said first motor and first speed reducer and said second motor and second speed reducer at a maximum value under its respective predetermined upper torque limit;
• memorizing the calculated combination-values in a memory device corresponding to said combinations of said discrete value parameters;
• reading in positional data for an initial position P.sub.i and a subsequent position P.sub.i+1 ;
• calculating factors used for said discrete value parameters from positional data for the initial position P.sub.i and a subsequent position P.sub.i+1 ;
• comparing said factors calculated value with said stored discrete value parameters and obtaining the acceleration time or the displacement amount during acceleration and the deceleration time or the displacement amount during deceleration, which correspond to the nearest discrete value parameters;
• using said acceleration time or said displacement amount during said acceleration obtained by said comparing step as a reference value for said reference acceleration curve and issuing velocity instruction values or a desired displacement positional instruction during acceleration;
• and
• using said deceleration time or said displacement amount during deceleration obtained by said comparing step as a reference for said reference deceleration curve and issuing velocity instructions value or a desired transfer positional instruction in the deceleration.