Patent US5430643A successfully refreshed from Google Patents.
US5430643A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Configuration control of seven degree of freedom arms
Assignee: California Institute of Technology
•
Filing: 1992-03-11
•
Granted: 1995-07-04
•
Expires: 2012-03-11
Abstract
Abstract A seven-degree-of-freedom robot arm with a six-degree-of-freedom end effector is controlled by a processor employing a 6-by-7 Jacobian matrix for defining location and orientation of the end effector in terms of the rotation angles of the joints, a 1 (or more)-by-7 Jacobian matrix for defining 1 (or more) user-specified kinematic functions constraining location or movement of selected portions of the arm in terms of the joint angles, the processor combining the two Jacobian matrices to produce an augmented 7 (or more)-by-7 Jacobian matrix, the processor effecting control by computing in accordance with forward kinematics from the augmented 7-by-7 Jacobian matrix and from the seven joint angles of the arm a set of seven desired joint angles for transmittal to the joint servo loops of the arms. One of the kinematic functions constrains the orientation of the elbow plane of the arm. Another one of the kinematic functions minimizing a sum of gravitational torques on the joints. Still another one of the kinematic functions constrains the location of the arm to perform collision avoidance. Generically, one of the kinematic functions minimizes a sum of selected mechanical parameters of at least some of the joints associated with weighting coefficients which may be changed during arm movement. The mechanical parameters may be velocity errors or position errors or gravity torques associated with individual joints.
Inventors
- 👤 Homayoun Seraji
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-23 22:16
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/16; B25J9/1628; B25J9/1643; G; G05; G05B; G05B2219/00; G05B2219/30; G05B2219/33; G05B2219/33169; G05B2219/34; G05B2219/34403; G05B2219/39; G05B2219/39062; G05B2219/39081; G05B2219/39082; G05B2219/39414; G05B2219/39422; G05B2219/40; G05B2219/40317; G05B2219/40342; G05B2219/40345; G05B2219/40362; G05B2219/40371; G05B2219/40379
Claims Analysis
Total Claims: 27
Claim 1
Independent Claim
211 words
A method of controlling a robot arm, said robot arm comprising n joints, joint angle sensor means connected to each of said joints, joint servo loop means connected to each of said joints, and two ends comprising a fixed pedestal end and a movable hand end, each of said joints having a joint angle specifying a rotational orientation of said joint, said hand end having m degrees of freedom of movement, wherein m is less than n whereby said robot arm characterized by a degree of redundancy, n-m, said method comprising: first defining a first m-by-n matrix for defining location and orientation of said hand end in terms of said rotation angles of said joints; second defining a second r-by-n matrix for defining r user-specified kinematic functions in terms of said joint angles, wherein r is a positive integer exceeding the degree of redundancy of said robot arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; and computing in accordance with forward kinematics from said augmented m+r-by-n matrix and from the joint angles sensed by said joint angle sensor means a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop means to control the robot arm.
Claim 2
Independent Claim
211 words
A method of controlling a robot arm, said robot arm comprising n joints, joint angle sensor means connected to each of said joints, joint servo loop means connected to each of said joints, and two ends comprising a fixed pedestal end and a movable hand end, each of said joints having a joint angle specifying a rotational orientation of said joint, said hand end having m degrees of freedom of movement, wherein m is less than n whereby said robot arm characterized by a degree of redundancy, n-m, said method comprising: first defining a first m-by-n matrix for defining location and orientation of said hand end in terms of said rotation angles of said joints; second defining a second r-by-n matrix for defining r user-specified kinematic functions in terms of said joint angles, wherein r is a positive integer exceeding the degree of redundancy of said robot arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; and computing in accordance with forward kinematics from said augmented m+r-by-n matrix and from the joint angles sensed by said joint angle sensor means a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop means to control the robot arm.
Claim 3
Dependent Claim
31 words
The method of claim 1 wherein each of said kinematic functions defines a constraint in one of (a) location, (b) orientation and (c) configuration of a specified portion of said arm.
Claim 4
Dependent Claim
46 words
The method of claim 1 wherein said computing operates in successive iterations, said joint angles sensed by said joint angle sensor means correspond to a current one of said iterations and said set of n desired joint angles correspond to a next one of said iterations.
Claim 5
Dependent Claim
20 words
The method of claim 1 wherein said first m-by-n matrix, second r-by-n matrix and augmented m+r-by-n matrix comprise Jacobian matrices.
Claim 6
Dependent Claim
60 words
The method of claim 1 wherein said robot arm has an anthropomorthic structure and one of said joints is an elbow joint, wherein a pair of links of said arm joined together by said elbow joint define an elbow plane of said arm, and wherein one of said kinematic functions comprises means for defining an orientation of said elbow plane.
Claim 7
Dependent Claim
24 words
The method of claim 1 wherein one of said kinematic functions minimizes a sum of gravitational torques on at least some of said joints.
Claim 8
Dependent Claim
18 words
The method of claim 1 wherein at least one of said kinematic functions constrains location of said arm.
Claim 9
Dependent Claim
27 words
The method of claim 1 wherein at least one of said kinematic functions minimizes a sum of selected mechanical parameters of at least some of said joints.
Claim 10
Dependent Claim
18 words
The method of claim 8 wherein said parameters comprising different weighting coefficients for different ones of said joints.
Claim 11
Dependent Claim
15 words
The method of claim 9 further changing said weighting coefficients during movement of said arm.
Claim 12
Dependent Claim
22 words
The method of claim 8 wherein one of said mechanical parameters comprises velocity errors of said joints with respect to desired velocities.
Claim 13
Dependent Claim
21 words
The method of claim 8 wherein one of said mechanical parameters comprises joint angle errors with respect to desired joint angles.
Claim 14
Dependent Claim
60 words
The method of claim 5 wherein: a second one of said kinematic functions minimizes a sum of gravitational torques on at least some of said joints; a third one of said kinematic functions constrains location of said arm; and a fourth one of said kinematic functions minimizes a sum of selected mechanical parameters of at least some of said joints.
Claim 15
Dependent Claim
27 words
The method of claim 1 wherein at least one of said user-specified functions corresponds to one of: i. joint locking; ii. joint limit avoidance; iii. manipulability maximization.
Claim 16
Independent Claim
262 words
A method of controlling a robot arm, said robot arm comprising n joints, joint angle sensor means connected to each of said joints, joint servo loop means connected to each of said joints, and two ends comprising a fixed pedestal end and a movable hand end, each of said joints having a joint angle specifying a rotational orientation of said joint, said hand end having m degrees of freedom of movement, wherein m is less than n whereby said robot arm characterized by a degree of redundancy, n-m, said method comprising: first defining a first m-by-n matrix for defining location and orientation of said hand end in terms of said rotation angles of said joints; second defining a second r-by-n matrix for defining r user-specified kinematic functions in terms of said joint angles, wherein r is a positive integer exceeding the degree of redundancy of said robot arm, and wherein at least one of said kinematic functions minimizes a sum of selected mechanical parameters of at least some of said joints and said selected mechanical parameters include different weighting coefficients for different ones of said joints, said weighting coefficients being able to be changed during movement of said arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; and computing in accordance with forward kinematics from said augmented m+r-by-n matrix and from the joint angles sensed by said joint angle sensor means a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop means to control the robot arm.
Claim 17
Independent Claim
262 words
A method of controlling a robot arm, said robot arm comprising n joints, joint angle sensor means connected to each of said joints, joint servo loop means connected to each of said joints, and two ends comprising a fixed pedestal end and a movable hand end, each of said joints having a joint angle specifying a rotational orientation of said joint, said hand end having m degrees of freedom of movement, wherein m is less than n whereby said robot arm characterized by a degree of redundancy, n-m, said method comprising: first defining a first m-by-n matrix for defining location and orientation of said hand end in terms of said rotation angles of said joints; second defining a second r-by-n matrix for defining r user-specified kinematic functions in terms of said joint angles, wherein r is a positive integer exceeding the degree of redundancy of said robot arm, and wherein at least one of said kinematic functions minimizes a sum of selected mechanical parameters of at least some of said joints and said selected mechanical parameters include different weighting coefficients for different ones of said joints, said weighting coefficients being able to be changed during movement of said arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; and computing in accordance with forward kinematics from said augmented m+r-by-n matrix and from the joint angles sensed by said joint angle sensor means a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop means to control the robot arm.
Claim 18
Dependent Claim
46 words
The method of claim 15 wherein said computing operates in successive iterations, said joint angles sensed by said joint angle sensor means correspond to a current one of said iterations and said set of n desired joint angles correspond to a next one of said iterations.
Claim 19
Dependent Claim
20 words
The method of claim 15 wherein said first m-by-n matrix, second r-by-n matrix and augmented m+r-by-n matrix comprise Jacobian matrices.
Claim 20
Dependent Claim
20 words
The method of claim 15 wherein said mechanical parameters comprise velocity errors of said joints with respect to desired velocities.
Claim 21
Dependent Claim
19 words
The method of claim 15 wherein said mechanical parameters comprise joint angle errors with respect to desired joint angles.
Claim 22
Independent Claim
294 words
A method of controlling a robot arm, said robot arm comprising n joints, joint angle sensor means connected to each of said joints, joint servo loop means connected to each of said joints, and two ends comprising a fixed pedestal end and a movable hand end, each of said joints having a joint angle specifying a rotational orientation of said joint, said hand end having m degrees of freedom of movement, wherein m is less than n whereby said robot arm characterized by a degree of redundancy, n-m, said method comprising: first defining a first m-by-n matrix for defining location and orientation of said hand end in terms of said rotation angles of said joints; second defining a second r-by-n matrix for defining r user-specified kinematic functions in terms of said joint angles, wherein r is a positive integer exceeding the degree of redundancy of said robot arm, and wherein at least one of said kinematic functions corresponds to one of, i. minimizing a sum of gravitational torques on at least some of said joints, ii. minimizing a sum of selected mechanical parameters of at least some of said joints, said parameters comprising velocity errors of said joints with respect to desired velocities, and iii. minimizing a sum of selected mechanical parameters of at least some of said joints, said parameters comprising joint angle errors with respect to desired joint angles; combining said first and second matrices to produce an augmented m+r-by-n matrix; and computing in accordance with forward kinematics from said augmented m+r-by-n matrix and from the joint angles sensed by said joint angle sensor means a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop means to control the robot arm.
Claim 23
Independent Claim
294 words
A method of controlling a robot arm, said robot arm comprising n joints, joint angle sensor means connected to each of said joints, joint servo loop means connected to each of said joints, and two ends comprising a fixed pedestal end and a movable hand end, each of said joints having a joint angle specifying a rotational orientation of said joint, said hand end having m degrees of freedom of movement, wherein m is less than n whereby said robot arm characterized by a degree of redundancy, n-m, said method comprising: first defining a first m-by-n matrix for defining location and orientation of said hand end in terms of said rotation angles of said joints; second defining a second r-by-n matrix for defining r user-specified kinematic functions in terms of said joint angles, wherein r is a positive integer exceeding the degree of redundancy of said robot arm, and wherein at least one of said kinematic functions corresponds to one of, i. minimizing a sum of gravitational torques on at least some of said joints, ii. minimizing a sum of selected mechanical parameters of at least some of said joints, said parameters comprising velocity errors of said joints with respect to desired velocities, and iii. minimizing a sum of selected mechanical parameters of at least some of said joints, said parameters comprising joint angle errors with respect to desired joint angles; combining said first and second matrices to produce an augmented m+r-by-n matrix; and computing in accordance with forward kinematics from said augmented m+r-by-n matrix and from the joint angles sensed by said joint angle sensor means a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop means to control the robot arm.
Claim 24
Dependent Claim
46 words
The method of claim 20 wherein said computing operates in successive iterations, said joint angles sensed by said joint angle sensor means correspond to a current one of said iterations and said set of n desired joint angles correspond to a next one of said iterations.
Claim 25
Dependent Claim
20 words
The method of claim 21 wherein said first m-by-n matrix, second r-by-n matrix and augmented m+r-by-n matrix comprise Jacobian matrices.
Claim 26
Dependent Claim
21 words
The method of claim 21 wherein said selected mechanical parameters further include different weighting coefficients for different ones of said joints.
Claim 27
Dependent Claim
15 words
The method of claim 23 further changing said weighting coefficients during movement of said arm.
References Cited (Backward Citations)
US4156835A
Cited
US4594671A
Cited
US4547858A
Cited
US4706204A
Cited
US4725942A
Cited
US4794547A
Cited
US4680519A
Cited
US4975856A
Cited
US5155423A
Cited
US4725965A
Cited
US4828451A
Cited
US4828453A
Cited
US4835710A
Cited
US4808063A
Cited
US5053687A
Cited
US4893254A
Cited
US5020001A
Cited
US4972347A
Cited
US5049796A
Cited
US4999553A
Cited
US4967126A
Cited
US5150026A
Cited
US5214749A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1998-07-03 | 1999-01-02 | 1999-07-04 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2002-07-03 | 2003-01-02 | 2003-07-04 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2006-07-03 | 2007-01-02 | 2007-07-04 | $7700.00 | Window Closed / Lapsed |