US4967126A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Method of controlling a seven degree of freedom manipulator arm
Assignee: Lanteris Space LLC
•
Filing: 1990-01-30
•
Granted: 1990-10-30
•
Expires: 2010-01-30
Abstract
Abstract The present invention is a control system for a seven-degree-of-freedom robotic arm. The robotic arm (10) includes two links (12 and 14), each having two degrees of freedom, and a spherical wrist (26) having three degrees of freedom. The kinematics of the spherical wrist are decoupled from the kinematics of the arm. The four degrees of freedom of the arm create a redundancy which provides versatility in the positioning of the arm. Fixing the redundant arm parameter and locating the end point (24) of the end effectuator path away from areas of limited mobility results in a marked simplification of the algorithms which describe the equations of motion of the arm. Additionally, further computation reduction can be achieved by updating the control gains less frequently than every microprocessor cycle, such as updating once for every five degrees of pitch angle rotation of either joint.
Inventors
- 👤 Bruce D. Gretz
- 👤 Scott W. Tilley
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-01 07:41
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/16; B25J9/1628; B25J9/1643; B25J9/1612; G; G05; G05B; G05B2219/00; G05B2219/30; G05B2219/34; G05B2219/34135; G05B2219/40; G05B2219/40333; G05B2219/41; G05B2219/41005
Claims Analysis
Total Claims: 30
Claim 1
Independent Claim
305 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; identifying a redundant rotational degree of freedom in said arm; utilizing a constraint that said redundant degree of freedom is equal to a fixed value; determining final values of three remaining rotational degrees of freedom; utilizing an equation ##EQU6## wherein: τ c =joint control torque K p =a diagonal matrix containing position gain information K r =a diagonal matrix containing rate gain information S=a coordinate transformation matrix S T =a transform of matrix S such that S T S=I θ=a vector of joint angles θ=rate of change of θ to determine the joint control torque of each rotational degree of freedom; and solving said equation to determine the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 2
Dependent Claim
305 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; identifying a redundant rotational degree of freedom in said arm; utilizing a constraint that said redundant degree of freedom is equal to a fixed value; determining final values of three remaining rotational degrees of freedom; utilizing an equation ##EQU6## wherein: τ c =joint control torque K p =a diagonal matrix containing position gain information K r =a diagonal matrix containing rate gain information S=a coordinate transformation matrix S T =a transform of matrix S such that S T S=I θ=a vector of joint angles θ=rate of change of θ to determine the joint control torque of each rotational degree of freedom; and solving said equation to determine the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 3
Dependent Claim
50 words
A method for controlling the movement of a robotic arm as described in claim 1 wherein said two rotational degrees of freedom of said shoulder joint are roll angle and pitch angle, and wherein said two rotational degrees of freedom of said elbow joint are roll angle and pitch angle.
Claim 4
Dependent Claim
30 words
A method for controlling the movement of a robotic arm as described in claim 2 wherein said redundant rotational degree of freedom is said roll angle of said elbow joint.
Claim 5
Dependent Claim
32 words
A method for controlling the movement of a robotic arm as described in claim 3 wherein the value of said roll angle of said elbow joint is constrained to equal zero degrees.
Claim 6
Dependent Claim
37 words
A method for controlling the movement of a robotic arm as described in claim 1, further including; utilizing a mathematical spline to provide path solutions to plan the path of said second end of said second link.
Claim 7
Dependent Claim
71 words
A method for controlling the movement of a robotic arm as described in claim 5 wherein said spline is represented by an equation: ##EQU7## wherein t is the actual time from the start of the maneuver, T is the total maneuver time, x i is a spatial coordinate of said initial position and x f is a spatial coordinate of said final position of said second end of said second link.
Claim 8
Dependent Claim
42 words
A method for controlling the movement of a robotic arm as described in claim 1 including updating said torque control values once for every five degrees of change of one of said shoulder joint pitch angle or elbow joint pitch angle parameters.
Claim 9
Dependent Claim
280 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; identifying a redundant rotational degree of freedom in said arm; utilizing a constraint that said redundant degree of freedom is equal to a fixed value; determining final values of the three remaining rotational degrees of freedom; utilizing an equation ##EQU8## wherein: τ c =joint control torque M=mass matrix ω=closed loop frequency ζ=a damping constant θ=a vector of joint angles θ=the rate of change of θ to determine a control torque of each rotational degree of freedom; and solving said equation to determine the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 10
Dependent Claim
280 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; identifying a redundant rotational degree of freedom in said arm; utilizing a constraint that said redundant degree of freedom is equal to a fixed value; determining final values of the three remaining rotational degrees of freedom; utilizing an equation ##EQU8## wherein: τ c =joint control torque M=mass matrix ω=closed loop frequency ζ=a damping constant θ=a vector of joint angles θ=the rate of change of θ to determine a control torque of each rotational degree of freedom; and solving said equation to determine the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 11
Dependent Claim
50 words
A method for controlling the movement of a robotic arm as described in claim 8 wherein said two rotational degrees of freedom of said shoulder joint are roll angle and pitch angle, and wherein said two rotational degrees of freedom of said elbow joint are roll angle and pitch angle.
Claim 12
Dependent Claim
30 words
A method for controlling the movement of a robotic arm as described in claim 9 wherein said redundant rotational degree of freedom is said roll angle of said elbow joint.
Claim 13
Dependent Claim
32 words
A method for controlling the movement of a robotic arm as described in claim 10 wherein a value of said roll angle of said elbow joint is constrained to equal zero degrees.
Claim 14
Dependent Claim
37 words
A method for controlling the movement of a robotic arm as described in claim 8, further including; utilizing a mathematical spline to provide path solutions to plan the path of said second end of said second link.
Claim 15
Dependent Claim
71 words
A method for controlling the movement of a robotic arm as described in claim 12 wherein said spline is represented by an equation: ##EQU9## wherein t is an actual time from the start of the maneuver, T is a total maneuver time, x i is a spatial coordinate of said initial position and x f is a spatial coordinate of said final position of said second end of said second link.
Claim 16
Dependent Claim
42 words
A method for controlling the movement of a robotic arm as described in claim 8 including updating said torque control values once for every five degrees of change of one of said shoulder joint pitch angle or elbow joint pitch angle parameters.
Claim 17
Dependent Claim
292 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; utilizing a first equation ##EQU10## wherein: τ c =joint control torque K p =a diagonal matrix containing position gain information K r =a diagonal matrix containing rate gain information S=a coordinate transformation matrix S T =a transform of matrix S such that S T S =I θ=a vector of joint angles θ=rate of change of θ to determine the joint control torque of each rotational degree of freedom; utilizing a constraint that the velocities of said elbow joint rotational degrees of freedom and said shoulder joint rotational degrees of freedom be minimized; and determining the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 18
Dependent Claim
292 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; utilizing a first equation ##EQU10## wherein: τ c =joint control torque K p =a diagonal matrix containing position gain information K r =a diagonal matrix containing rate gain information S=a coordinate transformation matrix S T =a transform of matrix S such that S T S =I θ=a vector of joint angles θ=rate of change of θ to determine the joint control torque of each rotational degree of freedom; utilizing a constraint that the velocities of said elbow joint rotational degrees of freedom and said shoulder joint rotational degrees of freedom be minimized; and determining the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 19
Dependent Claim
45 words
A method for controlling the movement of a robotic arm as described in claim 13, further including determining said velocities utilizing a second equation θ(t)=J.sup.t X(t), where X(t) is a vector of space tip coordinates and J t is a Jacobean pseudo inverse mathematical function.
Claim 20
Dependent Claim
50 words
A method for controlling the movement of a robotic arm as described in claim 16 wherein said two rotational degrees of freedom of said shoulder joint are roll angle and pitch angle, and wherein said two rotational degrees of freedom of said elbow joint are roll angle and pitch angle.
Claim 21
Dependent Claim
37 words
A method for controlling the movement of a robotic arm as described in claim 16, further including; utilizing a mathematical spline to provide path solutions to plan the path of said second end of said second link.
Claim 22
Dependent Claim
72 words
A method for controlling the movement of a robotic arm as described in claim 18 wherein said spline is represented by an equation: ##EQU11## wherein t is an actual time from the start of the maneuver, T is a total maneuver time, and x i is a spatial coordinate of said initial position and x f is a spatial coordinate of said final position of said second end of said second link.
Claim 23
Dependent Claim
43 words
A method for controlling the movement of a robotic arm as described in claim 16 including updating said torque control values once for every five degrees of change of one of said shoulder joint pitch angle or said elbow joint pitch angle parameters.
Claim 24
Dependent Claim
266 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying the three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; utilizing a first equation ##EQU12## wherein: τ c =joint control torque M=mass matrix ω=closed loop frequency ζ=a damping constant θ=a vector of joint angles θ=rate of change of θ to determine the joint control torque of each rotational degree of freedom; utilizing a constraint that the velocities of said elbow joint rotational degrees of freedom and said shoulder joint rotational degrees of freedom be minimized; and determining the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 25
Dependent Claim
266 words
An improved method for controlling the movement of a robotic arm from an initial position to a final position, comprising: constructing a robotic arm having a first link and a second link, each said link having a first end and a second end; said first link being joined to a fixed surface at said first end thereof by a shoulder joint having two rotational degrees of freedom, and said second link being joined at said first end thereof to said second end of said first link by an elbow joint having two rotational degrees of freedom; identifying the three spatial displacement coordinates of said initial position of said second end of said second link; identifying three spatial coordinates of said final position for said second end of said second link; identifying initial values of said two rotational degrees of freedom of said shoulder joint; identifying initial values of said two rotational degrees of freedom of said elbow joint; utilizing a first equation ##EQU12## wherein: τ c =joint control torque M=mass matrix ω=closed loop frequency ζ=a damping constant θ=a vector of joint angles θ=rate of change of θ to determine the joint control torque of each rotational degree of freedom; utilizing a constraint that the velocities of said elbow joint rotational degrees of freedom and said shoulder joint rotational degrees of freedom be minimized; and determining the joint control torque for each rotational degree of freedom, and providing signals to control said shoulder joint and said elbow joint such that said second end of said second link is directed from said initial position to said final position.
Claim 26
Dependent Claim
45 words
A method for controlling the movement of a robotic arm as described in claim 21, further including determining said velocities utilizing a second equation θ(t)=J.sup.t X(t), where X(t) is a vector of space tip coordinates and J t is a Jacobean pseudo inverse mathematical function.
Claim 27
Dependent Claim
50 words
A method for controlling the movement of a robotic arm as described in claim 22 wherein said two rotational degrees of freedom of said shoulder joint are roll angle and pitch angle, and wherein said two rotational degrees of freedom of said elbow joint are roll angle and pitch angle.
Claim 28
Dependent Claim
37 words
A method for controlling the movement of a robotic arm as described in claim 23, further including; utilizing a mathematical spline to provide path solutions to plan the path of said second end of said second link.
Claim 29
Dependent Claim
70 words
A method for controlling the movement of a robotic arm as described in claim 24 wherein said spline is represented by an equation: ##EQU13## wherein t is an actual time from the start of the maneuver, T is total maneuver time, x i is a spatial coordinate of said initial position and x f is a spatial coordinate of said final position of said second end of said second link.
Claim 30
Dependent Claim
44 words
A method for controlling the movement of a robotic arm as described in claim 22 including updating said joint torque control values once for every five degrees of change of one of said shoulder joint pitch angle or said elbow joint pitch angle parameters.
References Cited (Backward Citations)
US4860215A
Cited
US4808063A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1993-10-29 | 1994-04-30 | 1994-10-30 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1997-10-29 | 1998-04-30 | 1998-10-30 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2001-10-29 | 2002-04-30 | 2002-10-30 | $7700.00 | Window Closed / Lapsed |