Patent US5737500A successfully refreshed from Google Patents.
US5737500A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Mobile dexterous siren degree of freedom robot arm with real-time control system
Assignee: California Institute of Technology
•
Filing: 1995-04-28
•
Granted: 1998-04-07
•
Expires: 2015-04-28
Abstract
Abstract The present invention is a mobile redundant dexterous manipulator with a seven-degree-of-freedom robot arm mounted on a 1 degree-of-freedom mobile platform with a six-degree-of freedom end effector including a real-time control system with multiple modes of operation. The manipulator-plus-platform system has two degrees-of-redundancy for the task of hand placement and orientation. The redundancy resolution is achieved by accomplishing two additional tasks using a configuration control technique. This mobile manipulator with control system allows a choice of arm angle control or collision avoidance for the seventh task, and platform placement or elbow angle control for the eighth task. In addition, joint limit avoidance task is automatically invoked when any of the joints approach their limits. The robot is controlled by a processor employing a 6-by-7 Jacobian matrix for defining location and orientation of the end effector.
Inventors
- 👤 Homayoun Seraji
- 👤 David Lim
- 👤 Thomas S. Lee
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-23 16:15
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/39172; G05B2219/39174; G05B2219/39414; G05B2219/39422; G05B2219/40; G05B2219/40252; G05B2219/40293; G05B2219/40297; G05B2219/40298; G05B2219/40317; G05B2219/40327; G05B2219/40342; G05B2219/40345; G05B2219/40362; G05B2219/40371; G05B2219/40379
Claims Analysis
Total Claims: 36
Claim 1
Independent Claim
251 words
A method of controlling a robot arm, said robot arm comprising a base with a central axis, 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 mobile platform end having two degrees-of-redundancy 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 and said robot arm is characterized by a degree of redundancy, 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 to the degree of redundancy of said robot arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; 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; defining a translational position of said mobile platform end from said central axis of said base; and controlling said translational position of said mobile platform end by a platform motion controller.
Claim 2
Independent Claim
251 words
A method of controlling a robot arm, said robot arm comprising a base with a central axis, 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 mobile platform end having two degrees-of-redundancy 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 and said robot arm is characterized by a degree of redundancy, 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 to the degree of redundancy of said robot arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; 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; defining a translational position of said mobile platform end from said central axis of said base; and controlling said translational position of said mobile platform end by a platform motion controller.
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
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 5
Dependent Claim
87 words
The method of claim 1 wherein said robot arm has an anthropomorphic structure and one of said joint 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, wherein one of said kinematic functions comprises means for defining an orientation of said elbow plane, and wherein said platform motion controller comprises means for preselecting a wedge angle corresponding to said elbow plane and means for monitoring said orientation of said elbow plane.
Claim 6
Dependent Claim
98 words
The method of claim 4, further comprising, by said platform motion controller, the steps of: (a) defining an initial hand end position, x hi , of said robot arm; (b) defining an initial orientation of said elbow plane, φ i ; (c) defining lengths l 1 and l 2 , respectively, of said pair of links; and (e) commanding said mobile platform to move -Δ X .sbsb.h if said elbow plane does not equal said preselected wedge angle so that said elbow plane orientation returns to said preselected wedge angle and said hand position remains constant, wherein: ##EQU27##
Claim 7
Dependent Claim
18 words
The method of claim 1 wherein at least one of said kinematic functions constrains location of said arm.
Claim 8
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 9
Dependent Claim
18 words
The method of claim 7 wherein said parameters comprising different weighting coefficients for different ones of said joints.
Claim 10
Dependent Claim
15 words
The method of claim 8 further changing said weighting coefficients during movement of said arm.
Claim 11
Dependent Claim
22 words
The method of claim 7 wherein said one of mechanical parameters comprises velocity errors of said joints with respect to desired velocities.
Claim 12
Dependent Claim
21 words
The method of claim 7 wherein one of said mechanical parameters comprises joint angle errors with respect to desired joint angles.
Claim 13
Dependent Claim
27 words
The method of claim 9 wherein at least one of said user-specified functions corresponds to one of: i. joint limit avoidance; ii. trajectory generation; iii. arm simulation.
Claim 14
Dependent Claim
68 words
The method of claim 12 wherein said joint limit avoidance comprises the steps of: (a) initiating said platform motion controller if each of said joints are near their respective positional limits; and (b) relaxing movement of said joints based on respective weighting coefficients of said joints when one of said joints are near their respective positional limits so that each joint is not at a maximum positional limit.
Claim 15
Dependent Claim
67 words
The method of claim 12 wherein said trajectory generation comprises two independent trajectory generators, the first trajectory generator producing smooth continuous cycloidal functions so that transition from an initial value to a final value is made in a specified time, and a second trajectory generator specifying a plurality of via-points so that a smooth trajectory between points is generated and velocities between said via-points are smoothly blended.
Claim 16
Dependent Claim
15 words
The method of claim 5 wherein said arm simulation exactly duplicates said actual arm movements.
Claim 17
Independent Claim
302 words
A method of controlling a robot arm, said robot arm comprising a base with a central axis, n joints, a joint angle sensor device connected to each of said joints, a joint servo loop device connected to each of said joints, and two ends comprising a mobile platform 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 and said robot arm is 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; 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 device a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop device to control the robot arm; defining a translational position of said mobile platform end from said central axis of said base; and controlling said translational position of said mobile platform end by a platform motion controller.
Claim 18
Independent Claim
302 words
A method of controlling a robot arm, said robot arm comprising a base with a central axis, n joints, a joint angle sensor device connected to each of said joints, a joint servo loop device connected to each of said joints, and two ends comprising a mobile platform 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 and said robot arm is 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; 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 device a set of n desired joint angles and transmitting said set of n desired joint angles to said joint servo loop device to control the robot arm; defining a translational position of said mobile platform end from said central axis of said base; and controlling said translational position of said mobile platform end by a platform motion controller.
Claim 19
Dependent Claim
87 words
The method of claim 16 wherein said robot arm has an anthropomorphic structure and one of said joint 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, wherein one of said kinematic functions comprises means for defining an orientation of said elbow plane, and wherein said platform motion controller comprises means for preselecting a wedge angle corresponding to said elbow plane and means for monitoring said orientation of said elbow plane.
Claim 20
Dependent Claim
98 words
The method of claim 17, further comprising, by said platform motion controller, the steps of: (a) defining an initial hand end position, x hi , of said robot arm; (b) defining an initial orientation of said elbow plane, φ i ; (c) defining lengths l 1 and l 2 , respectively, of said pair of links; and (e) commanding said mobile platform to move -Δ X .sbsb.h if said elbow plane does not equal said preselected wedge angle so that said elbow plane orientation returns to said preselected wedge angle and said hand position remains constant, wherein: ##EQU28##
Claim 21
Dependent Claim
18 words
The method of claim 16 wherein at least one of said kinematic functions constrains location of said arm.
Claim 22
Independent Claim
332 words
A method of controlling a robot arm said robot arm comprising a base with a central axis, 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 and said robot arm is 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; 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; defining a translational position of said mobile platform end from said central axis of said base; and controlling said translational position of said mobile platform end by a platform motion controller.
Claim 23
Independent Claim
332 words
A method of controlling a robot arm said robot arm comprising a base with a central axis, 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 and said robot arm is 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; 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; defining a translational position of said mobile platform end from said central axis of said base; and controlling said translational position of said mobile platform end by a platform motion controller.
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.
Claim 28
Dependent Claim
52 words
The method of claim 20 further comprising the steps of: (a) operating said arm with a teleoperated commands; (b) providing automated commands issued by a trajectory generator; and (c) combining said teleoperated commands with said automated commands so said arm can be collectively operated by said teleoperated commands and said automated commands.
Claim 29
Dependent Claim
32 words
The method of claim 1 further comprising the step of performing said defining, combining, computing, and controlling steps continuously and in real-time, wherein said robot arm operates and performs said steps simultaneously.
Claim 30
Dependent Claim
32 words
The method of claim 16 further comprising the step of performing said defining, combining, computing, and controlling steps continuously and in real-time, wherein said robot arm operates and performs said steps simultaneously.
Claim 31
Dependent Claim
32 words
The method of claim 20 further comprising the step of performing said defining, combining, computing, and controlling steps continuously and in real-time, wherein said robot arm operates and performs said steps simultaneously.
Claim 32
Independent Claim
241 words
A method of controlling a robot arm in real-time, said robot arm comprising a base with a central axis, 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 mobile platform 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 and said robot arm is characterized by a degree of redundancy, 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 to the degree of redundancy of said robot arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; 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; and performing said defining, combining, and computing steps continuously and in real-time, wherein said robot arm operates and performs said steps simultaneously.
Claim 33
Independent Claim
241 words
A method of controlling a robot arm in real-time, said robot arm comprising a base with a central axis, 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 mobile platform 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 and said robot arm is characterized by a degree of redundancy, 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 to the degree of redundancy of said robot arm; combining said first and second matrices to produce an augmented m+r-by-n matrix; 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; and performing said defining, combining, and computing steps continuously and in real-time, wherein said robot arm operates and performs said steps simultaneously.
Claim 34
Dependent Claim
227 words
A robot arm for operating in a work envelope and performing tasks, comprising: a base with a central axis and n joints; a joint angle sensor device connected to each of said joints; joint servo loop means connected to each of said joints; two ends comprising a mobile platform end and a movable hand end; wherein each of said joints has a joint angle specifying a rotational orientation of said joint, wherein said hand end has m degrees of freedom of movement, wherein m is less than n, and wherein said robot arm is characterized by a degree of redundancy; means for 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; means for 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 to the degree of redundancy of said robot arm; means for combining said first and second matrices to produce an augmented m+r-by-n matrix; and means for 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 device 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 35
Dependent Claim
227 words
A robot arm for operating in a work envelope and performing tasks, comprising: a base with a central axis and n joints; a joint angle sensor device connected to each of said joints; joint servo loop means connected to each of said joints; two ends comprising a mobile platform end and a movable hand end; wherein each of said joints has a joint angle specifying a rotational orientation of said joint, wherein said hand end has m degrees of freedom of movement, wherein m is less than n, and wherein said robot arm is characterized by a degree of redundancy; means for 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; means for 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 to the degree of redundancy of said robot arm; means for combining said first and second matrices to produce an augmented m+r-by-n matrix; and means for 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 device 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 36
Dependent Claim
25 words
The method of claim 30, wherein said robot arm is controlled continuously and in real-time so that said robot arm operates and performs tasks simultaneously.
References Cited (Backward Citations)
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 2001-04-06 | 2001-10-06 | 2002-04-07 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2005-04-06 | 2005-10-06 | 2006-04-07 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2009-04-06 | 2009-10-06 | 2010-04-07 | $7700.00 | Window Closed / Lapsed |