US4771389A — Control method and unit for controlling a manipul…

Claim 1

Independent Claim 133 words

A method of controlling a robot or a manipulator having a plurality of arm shafts, which comprises the steps of: (a) determining a parameter, a, of a reference model in accordance with a positioning time (Tr) and a moving angle (Jw) from a starting point to an ending point of the control to the manipulator, where a is a parameter of a transfer function of said reference model; and (b) determining control gains (F 1 , F 2 , F 3 ) in accordance with the parameter a thus determined, where F 1 , F 2 and F 3 are control gains of first, second and third gain control means, respectively, thus removing the dispersion among the positioning times of each arm shaft and realizing a high speed positioning control of the manipulator.

Claim 2

Independent Claim 133 words

A method of controlling a robot or a manipulator having a plurality of arm shafts, which comprises the steps of: (a) determining a parameter, a, of a reference model in accordance with a positioning time (Tr) and a moving angle (Jw) from a starting point to an ending point of the control to the manipulator, where a is a parameter of a transfer function of said reference model; and (b) determining control gains (F 1 , F 2 , F 3 ) in accordance with the parameter a thus determined, where F 1 , F 2 and F 3 are control gains of first, second and third gain control means, respectively, thus removing the dispersion among the positioning times of each arm shaft and realizing a high speed positioning control of the manipulator.

Claim 3

Dependent Claim 46 words

The method of controlling a manipulator as claimed in claim 1 wherein the method further comprises the steps of: preliminarily preparing a table of the parameter of a in accordance with a function of a=f(Tr, θw) and storing said table in a ROM of a microprocessor.

Claim 4

Dependent Claim 70 words

The method of controlling a manipulator as claimed in claim 2 wherein the method further comprises the step of carrying out a table look-up operation for control gains F 1 =g 1 (a), F 2 =g 2 (a), F 3 =g 3 (a) which have preliminarily been prepared and stored in the ROM of the microprocessor together with the table of the parameter a, in accordance with the parameter a.

Claim 5

Independent Claim 188 words

A method of controlling a manipulator which comprises the steps of: (c) setting up a predetermined tolerance Δθ with respect to a target joint angle θr for the positioning control of the manipulator, a positioning time Tr, and a target joint angle θr; (d) calculating a moving angle θw from the starting point to the ending point of the control; (e) determining the parameter a of the following equation or transfer function ##EQU12## of a reference model; (f) calculating a reference model joint angle θ M and a reference model joint angle speed θ M from the reference model transfer function this determined; (g) determining the control gains (F 1 , F 2 , F 3 ) in accordance with the parameter a of the reference model; (h) calculating each control input u to the manipulator in accordance with the following equation, ##EQU13## (i) determining if the joint angle θ of the manipulator falls within the predetermined tolerance Δθ to the target joint angle θr; and (j) returning the control to the step (f) above or terminating the control in accordance with the result of the last determination.

Claim 6

Independent Claim 188 words

A method of controlling a manipulator which comprises the steps of: (c) setting up a predetermined tolerance Δθ with respect to a target joint angle θr for the positioning control of the manipulator, a positioning time Tr, and a target joint angle θr; (d) calculating a moving angle θw from the starting point to the ending point of the control; (e) determining the parameter a of the following equation or transfer function ##EQU12## of a reference model; (f) calculating a reference model joint angle θ M and a reference model joint angle speed θ M from the reference model transfer function this determined; (g) determining the control gains (F 1 , F 2 , F 3 ) in accordance with the parameter a of the reference model; (h) calculating each control input u to the manipulator in accordance with the following equation, ##EQU13## (i) determining if the joint angle θ of the manipulator falls within the predetermined tolerance Δθ to the target joint angle θr; and (j) returning the control to the step (f) above or terminating the control in accordance with the result of the last determination.

Claim 7

Dependent Claim 49 words

The method of controlling a manipulator as claimed in claim 4 wherein the method further comprises the step of applying a control signal corresponding to the control input u thus calculated to a D/A converter so as to control the manipulator in accordance with the result of the calculation.

Claim 8

Dependent Claim 171 words

A control unit for a manipulator, said control unit comprising: first detecting means for detecting a joint angle of an arm of the manipulator; second detecting means for detecting a joint angular velocity of the arm; reference setting means for setting a reference parameter in accordance with at least a preset time for positioning the arm; first, second and third gain means for respectively calculating first, second and third control gains in accordance with the reference parameter of the reference setting means; means for inputting a target joint angle of the arm and calculating a reference joint angle and a reference joint angular velocity of the arm in acordance with the target joint angle; and means for calculating a control input for positioning the arm of the manipulator based on the reference joint angle and the reference joint angular velocity, and the first, second and third control gains so that the joint angle of the arm is located within an allowable range of the target joint angle during the preset time.

Claim 9

Dependent Claim 171 words

A control unit for a manipulator, said control unit comprising: first detecting means for detecting a joint angle of an arm of the manipulator; second detecting means for detecting a joint angular velocity of the arm; reference setting means for setting a reference parameter in accordance with at least a preset time for positioning the arm; first, second and third gain means for respectively calculating first, second and third control gains in accordance with the reference parameter of the reference setting means; means for inputting a target joint angle of the arm and calculating a reference joint angle and a reference joint angular velocity of the arm in acordance with the target joint angle; and means for calculating a control input for positioning the arm of the manipulator based on the reference joint angle and the reference joint angular velocity, and the first, second and third control gains so that the joint angle of the arm is located within an allowable range of the target joint angle during the preset time.

Claim 10

Dependent Claim 31 words

A control unit as claimed in claim 6, wherein said reference parameter is set in accordance with the preset time and a displaced amount of the joint angle of the arm.

Claim 11

Dependent Claim 41 words

A control unit as claimed in claim 6 further including memory means for storing tables of said reference parameter and said first, second and third control gains, said calculating means operable for accessing said memory means for calculating said control input.

Annuity Stage	Window Opens	Payment Deadline	Surcharge Period Until	Estimated Fee	Status
3.5 Years (Year 4)	1991-09-13	1992-03-14	1992-09-13	$2000.00	Window Closed / Lapsed
7.5 Years (Year 8)	1995-09-13	1996-03-14	1996-09-13	$3760.00	Window Closed / Lapsed
11.5 Years (Year 12)	1999-09-13	2000-03-14	2000-09-13	$7700.00	Window Closed / Lapsed

Control method and unit for controlling a manipulator

Abstract

Inventors

Bibliographic Details

Claims Analysis

References Cited (Backward Citations)

USPTO Annuity & Maintenance Windows

Assigned Categories & Tags

Assign Category Tag