US5336982A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Dual-arm generalized compliant motion with shared control
Assignee: National Aeronautics and Space Administration
•
Filing: 1993-03-24
•
Granted: 1994-08-09
•
Expires: 2013-03-24
Abstract
Abstract A multiple arm generalized compliant motion robot control system governs dual multi-joint robot arms handling an object with both of the arms in accordance with input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously. A move-squeeze decomposition processor computes actual move and squeeze decomposition forces based upon current robot force sensor outputs. A compliant motion processor transforms plural object position perturbations of the plural behaviors from the respective behavior spaces to a common space, and computes a relative transformation to a behavior-commanded object position in accordance with the object position perturbations of the plural behaviors. A kinematics processor updates a transformation to a current commanded object position based upon the relative transformation to the behavior-commanded object position. A multiple arm squeeze control processor computes, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, to provide squeeze control. An inverse kinematics processor computes, from the commanded object position transformation and from the squeeze control position perturbation, new robot joint angles, and controls respective joints of the robot arms in accordance with the new robot joint angles.
Inventors
- 👤 Paul G. Backes
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-23 20:38
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/16; B25J9/1679; B25J9/1682; G; G05; G05B; G05B2219/00; G05B2219/30; G05B2219/39; G05B2219/39109; G05B2219/39129; G05B2219/40; G05B2219/40009; G05B2219/40027; G05B2219/40074; G05B2219/40184; G05B2219/40371
Claims Analysis
Total Claims: 48
Claim 1
Independent Claim
217 words
A multiple arm generalized compliant motion robot control system for governing a robot comprising dual multi-joint robot arms handling an object with both of said arms, comprising: means for defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; a move-squeeze decomposition processor means for computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; compliant motion processor means for transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and computing a relative transformation to a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; kinematics processor means for updating a transformation to a current commanded object position based upon the relative transformation to the behavior-commanded object position; multiple arm squeeze control processor means for computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and inverse kinematics processor means for computing, from the commanded object position transformation and from the squeeze control position perturbation, new robot arm grasp points, and for controlling respective joints of said robot arms in accordance with said new robot arm grasp points.
Claim 2
Dependent Claim
217 words
A multiple arm generalized compliant motion robot control system for governing a robot comprising dual multi-joint robot arms handling an object with both of said arms, comprising: means for defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; a move-squeeze decomposition processor means for computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; compliant motion processor means for transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and computing a relative transformation to a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; kinematics processor means for updating a transformation to a current commanded object position based upon the relative transformation to the behavior-commanded object position; multiple arm squeeze control processor means for computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and inverse kinematics processor means for computing, from the commanded object position transformation and from the squeeze control position perturbation, new robot arm grasp points, and for controlling respective joints of said robot arms in accordance with said new robot arm grasp points.
Claim 3
Dependent Claim
60 words
The system of claim 1 wherein: said plurality of input parameters comprises: Cartesian, stiffness parameters, force setpoints, joint limits, joint singularities dither wave parameters, teleoperation input frame of reference and a Cartesian trajectory; and said plurality of behaviors comprises, respectively, Cartesian stiffness control, force control, joint limit avoidance, joint singularity avoidance, dither wave motion, teleoperation control and Cartesian trajectory control.
Claim 4
Dependent Claim
30 words
The system of claim 2 wherein said compliant motion processor means comprises means for computing position perturbations for all of said plural behaviors and combining all of said position perturbations.
Claim 5
Dependent Claim
72 words
The system of claim 1 wherein one of said behaviors comprises Cartesian trajectory control, said system further comprising: trajectory processor means for computing a drive transformation to a relative object position in accordance with Cartesian trajectory input parameters; and wherein said kinematics processor means updates the transformation to a current commanded object position based upon the relative transformation to the behavior-commanded object position and based upon said drive transformation each sampling interval.
Claim 6
Dependent Claim
32 words
The system of claim 4 wherein said drive transformation is computed in accordance with input parameters specifying initial and destination object positions and in accordance with the number of elapsed sampling intervals.
Claim 7
Dependent Claim
57 words
The system of claim 1 wherein: one of said input parameters comprises move force set points; said compliant motion processor means comprises force control means for computing a position perturbation of said object in accordance with a product of a force control constant and a difference between said move force set points and said actual move forces.
Claim 8
Dependent Claim
83 words
The system of claim 1 wherein: said input parameters comprise joint angle limits and joint angle singularities for individual joints on said arms; said compliant motion processor means comprises means for computing for each of said arms a position perturbation of said object in accordance with a product of a force field constant and a reciprocal of a difference between actual joint angles sensed by joint angle sensors on said arms and corresponding ones of said joint angle limits and joint angle singularities.
Claim 9
Dependent Claim
31 words
The system of claim 6 wherein said joint angle limits, said joint angle singularities and said force set points are comprised within a generalized compliant motion primitive of user-specified input parameters.
Claim 10
Dependent Claim
36 words
The system of claim 1 wherein said new robot arm grasp points are computed repetitively in successive sample intervals and wherein said input parameters are changeable each sample interval whereby said plural behaviors are dynamically programmable.
Claim 11
Dependent Claim
54 words
The system of claim 1 wherein said plural behaviors comprise at least one of safety monitoring and termination condition monitoring, said system further comprising: means for stopping motion of said robot in response to predetermined quantities measured by predetermined sensors on said robot reaching predetermined values specified by corresponding ones of said input parameters.
Claim 12
Dependent Claim
33 words
The system of claim 10 wherein: there are plural such predetermined quantities and said means for stopping stops said robot motion in response to all of said predetermined quantities meeting said predetermined values.
Claim 13
Dependent Claim
205 words
A multiple arm generalized compliant motion robot control system for governing a robot comprising dual multi-joint robot arms handling an object with both of said arms, comprising: means for defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; a move-squeeze decomposition processor means for computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; compliant motion processor means for transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and computing a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; kinematics processor means for updating a current commanded object position based upon the behavior-commanded object position; multiple arm squeeze control processor means for computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and inverse kinematics processor means for computing, from the commanded object position and from the squeeze control position perturbation, new robot arm grasp points and for controlling respective joints of said robot arms in accordance with said new robot arm grasp points.
Claim 14
Dependent Claim
205 words
A multiple arm generalized compliant motion robot control system for governing a robot comprising dual multi-joint robot arms handling an object with both of said arms, comprising: means for defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; a move-squeeze decomposition processor means for computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; compliant motion processor means for transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and computing a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; kinematics processor means for updating a current commanded object position based upon the behavior-commanded object position; multiple arm squeeze control processor means for computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and inverse kinematics processor means for computing, from the commanded object position and from the squeeze control position perturbation, new robot arm grasp points and for controlling respective joints of said robot arms in accordance with said new robot arm grasp points.
Claim 15
Dependent Claim
60 words
The system of claim 12 wherein: said plurality of input parameters comprises: Cartesian stiffness parameters, force setpoints, joint limits, joint singularities, dither wave parameters, teleoperation input frame of reference and a Cartesian trajectory; and said plurality of behaviors comprises, respectively, Cartesian stiffness control, force control, joint limit avoidance, joint singularity avoidance, dither wave motion, teleoperation control and Cartesian trajectory control.
Claim 16
Dependent Claim
30 words
The system of claim 13 wherein said compliant motion processor means comprises means for computing position perturbations for all of said plural behaviors and combining all of said position perturbations.
Claim 17
Dependent Claim
59 words
The system of claim 12 wherein one of said behaviours comprises Cartesian trajectory control, said system further comprising: trajectory processor means for computing a relative object position in accordance with Cartesian trajectory input parameters; and wherein said kinematics processor means updates the current commanded object position based upon the behavior-commanded object position and based upon said relative object position.
Claim 18
Dependent Claim
33 words
The system of claim 15 wherein said relative object position is computed in accordance with input parameters specifying initial and destination object positions and in accordance with the number of elapsed sampling intervals.
Claim 19
Dependent Claim
57 words
The system of claim 12 wherein: one of said input parameters comprises move force set points; said compliant motion processor means comprises force control means for computing a position perturbation of said object in accordance with a product of a force control constant and a difference between said move force set points and said actual move forces.
Claim 20
Dependent Claim
83 words
The system of claim 12 wherein: said input parameters comprise joint angle limits and joint angle singularities for individual joints on said arms; said compliant motion processor means comprises means for computing for each of said arms a position perturbation of said object in accordance with a product of a force field constant and a reciprocal of a difference between actual joint angles sensed by joint angle sensors on said arms and corresponding ones of said joint angle limits and joint angle singularities.
Claim 21
Dependent Claim
31 words
The system of claim 17 wherein said joint angle limits, said joint angle singularities and said force set points are comprised within a generalized compliant motion primitive of user-specified input parameters.
Claim 22
Dependent Claim
36 words
The system of claim 12 wherein said new robot arm grasp points are computed repetitively in successive sample intervals and wherein said input parameters are changeable each sample interval whereby said plural behaviors are dynamically programmable.
Claim 23
Dependent Claim
54 words
The system of claim 12 wherein said plural behaviors comprise at least one of safety monitoring and termination condition monitoring, said system further comprising: means for stopping motion of said robot in response to predetermined quantities measured by predetermined sensors on said robot reaching predetermined values specified by corresponding ones of said input parameters.
Claim 24
Dependent Claim
33 words
The system of claim 21 wherein: there are plural such predetermined quantities and said means for stopping stops said robot motion in response to all of said predetermined quantities meeting said predetermined values.
Claim 25
Independent Claim
189 words
A method for controlling a robot comprising dual multi-joint robot arms handling an object with both of said arms for multiple arm compliant motion, comprising: defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; first computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; first transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and second computing a relative transformation to a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; updating a transformation to a current commanded object position based upon the relative transformation to the behavior-commanded object position; third computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and fourth computing, from the commanded object position transformation and from the squeeze control position perturbation, new robot arm grasp points, and controlling respective joints of said robot arms in accordance with said new robot joint angles.
Claim 26
Independent Claim
189 words
A method for controlling a robot comprising dual multi-joint robot arms handling an object with both of said arms for multiple arm compliant motion, comprising: defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; first computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; first transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and second computing a relative transformation to a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; updating a transformation to a current commanded object position based upon the relative transformation to the behavior-commanded object position; third computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and fourth computing, from the commanded object position transformation and from the squeeze control position perturbation, new robot arm grasp points, and controlling respective joints of said robot arms in accordance with said new robot joint angles.
Claim 27
Dependent Claim
60 words
The method of claim 23 wherein: said plurality of input parameters comprises: Cartesian stiffness parameters, force setpoints, joint limits, joint singularities, dither wave parameters, teleoperation input frame of reference and at Cartesian trajectory; and said plurality of behaviors comprises, respectively, Cartesian stiffness control, force control, joint limit avoidance, joint singularity avoidance, dither wave motion, teleoperation control and Cartesian trajectory control.
Claim 28
Dependent Claim
26 words
The method of claim 24 wherein said second computing comprises computing position perturbations for all of said plural behaviors and combining all of said position perturbations.
Claim 29
Dependent Claim
67 words
The method of claim 23 wherein one of said behaviors comprises Cartesian trajectory control, said method further comprising: fifth computing a drive transformation to a relative object position in accordance with Cartesian trajectory input parameters; and wherein said updating updates the transformation to a current commanded object position based upon the relative transformation to the behavior-commanded object position and based upon said drive transformation each sampling interval.
Claim 30
Dependent Claim
32 words
The method of claim 26 wherein said drive transformation is computed in accordance with input parameters specifying initial and destination object positions and in accordance with the number of elapsed sampling intervals.
Claim 31
Dependent Claim
51 words
The method of claim 23 wherein: one of said input parameters comprises move force set points; said second computing comprises computing a position perturbation of said object in accordance with a product of a force control constant and a difference between said move force set points and said actual move forces.
Claim 32
Dependent Claim
79 words
The method of claim 23 wherein: said input parameters comprise joint angle limits and joint angle singularities for individual joints on said arms; said second computing comprises computing for each of said arms a position perturbation of said object in accordance with a product of a force field constant and a reciprocal of a difference between actual joint angles sensed by joint angle sensors on said arms and corresponding ones of said joint angle limits and joint angle singularities.
Claim 33
Dependent Claim
31 words
The method of claim 28 wherein said joint angle limits, said joint angle singularities and said force set points are comprised within a generalized compliant motion primitive of user-specified input parameters.
Claim 34
Dependent Claim
40 words
The method of claim 23 wherein said new robot arm grasp points are computed repetitively in successive sample intervals, said method further comprising changing selected ones of said input parameters each sample interval whereby to dynamically program said plural behaviors.
Claim 35
Dependent Claim
52 words
The method of claim 23 wherein said plural behaviors comprise at least one of safety monitoring and termination condition monitoring, said method further comprising: stopping motion of said robot in response to predetermined quantities measured by predetermined sensors on said robot reaching predetermined values specified by corresponding ones of said input parameters.
Claim 36
Dependent Claim
31 words
The method of claim 32 wherein: there are plural such predetermined quantities and said stopping stops said robot motion in response to all of said predetermined quantities meeting said predetermined values.
Claim 37
Independent Claim
178 words
A method for controlling a robot comprising dual multi-joint robot arms handling an object with both of said arms for multiple arm compliant motion, comprising: defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; first computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; first transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and second computing a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; updating a current commanded object position based upon the behavior-commanded object position; third computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and fourth computing, from the commanded object position and from the squeeze control position perturbation, new robot arm grasp points, and controlling respective joints of said robot arms in accordance with said new robot arm grasp points.
Claim 38
Independent Claim
178 words
A method for controlling a robot comprising dual multi-joint robot arms handling an object with both of said arms for multiple arm compliant motion, comprising: defining plural input parameters governing plural respective behaviors to be exhibited by the robot in respective behavior spaces simultaneously; first computing actual move and squeeze decomposition forces based upon current robot force sensor outputs; first transforming plural object position perturbations of said plural behaviors from the respective behavior spaces to a common space, and second computing a behavior-commanded object position in accordance with the object position perturbations of said plural behaviors; updating a current commanded object position based upon the behavior-commanded object position; third computing, from appropriate squeeze force input parameters and from actual squeeze forces for each of the arms, a squeeze control position perturbation for each of the arms, whereby to provide squeeze control; and fourth computing, from the commanded object position and from the squeeze control position perturbation, new robot arm grasp points, and controlling respective joints of said robot arms in accordance with said new robot arm grasp points.
Claim 39
Dependent Claim
60 words
The method of claim 34 wherein: said plurality of input parameters comprises: Cartesian stiffness parameters, force setpoints, joint limits, joint singularities, dither wave parameters, teleoperation input frame of reference and a Cartesian trajectory; and said plurality of behaviors comprises, respectively, Cartesian stiffness control, force control, joint limit avoidance, joint singularity avoidance, dither wave motion, teleoperation control and Cartesian trajectory control.
Claim 40
Dependent Claim
26 words
The method of claim 35 wherein said second computing comprises computing position perturbations for all of said plural behaviors and combining all of said position perturbations.
Claim 41
Dependent Claim
54 words
The method of claim 34 wherein one of said behaviors comprises Cartesian trajectory control, said method further comprising: fifth computing a relative object position in accordance with Cartesian trajectory input parameters; and wherein said updating updates the current commanded object position based upon the behavior-commanded object position and based upon said relative object position.
Claim 42
Dependent Claim
33 words
The method of claim 37 wherein said relative object position is computed in accordance with input parameters specifying initial and destination object positions and in accordance with the number of elapsed sampling intervals.
Claim 43
Dependent Claim
51 words
The method of claim 34 wherein: one of said input parameters comprises move force set points. said second computing comprises computing a position perturbation of said object in accordance with a product of a force control constant and a difference between said move force set points and said actual move forces.
Claim 44
Dependent Claim
79 words
The method of claim 34 wherein: said input parameters comprise joint angle limits and joint angle singularities for individual joints on said arms; said second computing comprises computing for each of said arms a position perturbation of said object in accordance with a product of a force field constant and a reciprocal of a difference between actual joint angles sensed by joint angle sensors on said arms and corresponding ones of said joint angle limits and joint angle singularities.
Claim 45
Dependent Claim
31 words
The method of claim 39 wherein said joint angle limits, said joint angle singularities and said force set points are comprised within a generalized compliant motion primitive of user-specified input parameters.
Claim 46
Dependent Claim
42 words
The method of claim 34 wherein said new robot arm grasp points are computed repetitively in successive sample intervals and wherein said method further comprises changing selected ones of said input parameters each sample interval whereby to dynamically program said plural behaviors.
Claim 47
Dependent Claim
52 words
The method of claim 34 wherein said plural behaviors comprise at least one of safety monitoring and termination condition monitoring, said method further comprising: stopping motion of said robot in response to predetermined quantities measured by predetermined sensors on said robot reaching predetermined values specified by corresponding ones of said input parameters.
Claim 48
Dependent Claim
31 words
The method of claim 43 wherein: there are plural such predetermined quantities and said stopping stops said robot motion in response to all of said predetermined quantities meeting said predetermined values.
References Cited (Backward Citations)
US3890552A
Cited
US4756662A
Cited
US5023808A
Cited
US4762455A
Cited
US4964062A
Cited
US4925312A
Cited
US5038089A
Cited
US5116180A
Cited
US5031441A
Cited
US5023533A
Cited
US4974210A
Cited
US5086262A
Cited
US5039254A
Cited
US5072361A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1997-08-08 | 1998-02-07 | 1998-08-09 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2001-08-08 | 2002-02-07 | 2002-08-09 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2005-08-08 | 2006-02-07 | 2006-08-09 | $7700.00 | Window Closed / Lapsed |