Patent US4603284A successfully refreshed from Google Patents.
US4603284A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Control system for manipulator apparatus with resolved compliant motion control
Assignee: Staeubli International AG
•
Filing: 1984-06-05
•
Granted: 1986-07-29
•
Expires: 2004-06-05
Abstract
Abstract A control system for manipulator apparatus having a manipulator arm movable in a plurality of axes utilizes resolved compliant motion control to improve servo response characteristics. The position and velocity of the manipulator arm are controlled using load modeling to account for compliance in the arm and to synthesize feedback signals representing movement of a remote point of the arm to provide a loop bandwidth greater than is possible using feedback signals from inner less remote points of the manipulator that are closer to the drive points. The feedback signals are derived using predetermined combinations of force related feedback signals from the axis drive arrangements and position and velocity feedback signals of the manipulator apparatus at points closer to the main drive and support structure of the manipulator and before certain compliant portions of the manipulator arm. To further enhance response and control of the manipulator arm, load modeling is also used to provide controlled deceleration before the manipulator arm is brought to a stop during work operation.
Inventors
- 👤 William Perzley
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-23 15:15
CPC Classifications
B; B25; B25J; B25J13/00; B25J13/08; B25J9/00; B25J9/16; B25J9/1628; B25J9/1633; B25J9/1638
Claims Analysis
Total Claims: 31
Claim 1
Independent Claim
161 words
A control system for manipulator apparatus having a manipulator arm and a predetermined geometrical configuration and structure controllable in a plurality of axes, each controllable axis including drive arrangements for moving the manipulator structure in each of the respective axes, said manipulator structure including compliance intermediate outer portions of the manipulator arm and inner portions of the manipulator arm proximate the drive arrangements, said control system comprising: means for a feedback signal representing the velocity of the manipulator arm in at least one controllable axis, said feedback signal being sensed at and representing velocity at a point between said compliance and said drive arrangement; means for generating a drive signal representing the torque of the drive arrangement applied to the manipulator structure in said one controllable axis; and means responsive to said feedback signal and said drive signal for generating a synthesized feedback signal representing the velocity of the manipulator arm in said one axis at a point after said compliance.
Claim 2
Dependent Claim
161 words
A control system for manipulator apparatus having a manipulator arm and a predetermined geometrical configuration and structure controllable in a plurality of axes, each controllable axis including drive arrangements for moving the manipulator structure in each of the respective axes, said manipulator structure including compliance intermediate outer portions of the manipulator arm and inner portions of the manipulator arm proximate the drive arrangements, said control system comprising: means for a feedback signal representing the velocity of the manipulator arm in at least one controllable axis, said feedback signal being sensed at and representing velocity at a point between said compliance and said drive arrangement; means for generating a drive signal representing the torque of the drive arrangement applied to the manipulator structure in said one controllable axis; and means responsive to said feedback signal and said drive signal for generating a synthesized feedback signal representing the velocity of the manipulator arm in said one axis at a point after said compliance.
Claim 3
Dependent Claim
52 words
The control system of claim 1 further comprising means for providing command signals representing desired work movements of the manipulator arm and means responsive to said command signals and said synthesized feedback signals for moving said manipulator arm in accordance with said desired work movements and position represented by said command signals.
Claim 4
Dependent Claim
22 words
The control system of claim 2 wherein said command signals represent manipulator arm position and velocity in at least said one axis.
Claim 5
Dependent Claim
32 words
The control system of claim 2 wherein said command signal providing means further comprises means for providing predetermined controlled deceleration characteristic for the manipulator arm at the end of each arm movement.
Claim 6
Dependent Claim
18 words
The control system of claim 4 wherein said predetermined controlled deceleration characteristic is a constantly decreasing deceleration rate.
Claim 7
Dependent Claim
29 words
The control system of claim 2 further comprising means for storing and reading out program control signals, said command signal providing means being responsive to said program control signals.
Claim 8
Independent Claim
158 words
A method for controlling a manipulator having a manipulator arm controllable in a plurality of axes and a driven support structure for the manipulator arm, the method comprising the steps of: generating command signals representing at least the desired velocity of the manipulator arm in at least a first axis at a predetermined point on the manipulator structure, said manipulator structure including compliance intermediate said predetermined point and the driven point of the support structure; synthesizing feedback signals corresponding to position and velocity of the manipulator arm in at least said first axis at said predetermined point on the manipulator structure in response to measured position and velocity signals from the manipulator structure derived from measurement at a point closer to the driven point of the support structure than said predetermined point and before said compliance; and controlling movement of the manipulator arm in a servo loop in accordance with the synthesized feedback signals and the command signals.
Claim 9
Independent Claim
158 words
A method for controlling a manipulator having a manipulator arm controllable in a plurality of axes and a driven support structure for the manipulator arm, the method comprising the steps of: generating command signals representing at least the desired velocity of the manipulator arm in at least a first axis at a predetermined point on the manipulator structure, said manipulator structure including compliance intermediate said predetermined point and the driven point of the support structure; synthesizing feedback signals corresponding to position and velocity of the manipulator arm in at least said first axis at said predetermined point on the manipulator structure in response to measured position and velocity signals from the manipulator structure derived from measurement at a point closer to the driven point of the support structure than said predetermined point and before said compliance; and controlling movement of the manipulator arm in a servo loop in accordance with the synthesized feedback signals and the command signals.
Claim 10
Independent Claim
199 words
A method for controlling a manipulator having a manipulator arm and drive means for moving said arm in a plurality of axes, said arm having support structure which includes compliance in at least one of said axes intermediate the outer end of said arm and the drive means for said one axis, which comprises the steps of: generating a command signal representing at least the desired velocity of said arm in said one axis during movement to a predetermined location; generating a velocity feedback signal corresponding to the actual velocity of said manipulator arm in said one axis at a point between said compliance and said drive means for said one axis; developing a quantity corresponding to the component of velocity lost in said compliance during movement of said arm in said one axis; utilizing said actual velocity feedback signal and said lost velocity quantity to provide a synthetic velocity feedback signal representing the actual velocity of said arm in said one axis at a point between said compliance and the outer end of said arm; and controlling movement of said manipulator arm in said one axis in accordance with said command signal and said synthetic velocity feedback signal.
Claim 11
Independent Claim
199 words
A method for controlling a manipulator having a manipulator arm and drive means for moving said arm in a plurality of axes, said arm having support structure which includes compliance in at least one of said axes intermediate the outer end of said arm and the drive means for said one axis, which comprises the steps of: generating a command signal representing at least the desired velocity of said arm in said one axis during movement to a predetermined location; generating a velocity feedback signal corresponding to the actual velocity of said manipulator arm in said one axis at a point between said compliance and said drive means for said one axis; developing a quantity corresponding to the component of velocity lost in said compliance during movement of said arm in said one axis; utilizing said actual velocity feedback signal and said lost velocity quantity to provide a synthetic velocity feedback signal representing the actual velocity of said arm in said one axis at a point between said compliance and the outer end of said arm; and controlling movement of said manipulator arm in said one axis in accordance with said command signal and said synthetic velocity feedback signal.
Claim 12
Dependent Claim
51 words
The method of claim 8, wherein said synthetic velocity feedback signal is equal to θ 1 -1/K 1 (d/dt)(T), where θ 1 is said actual velocity feedback signal, K 1 is the spring rate of said compliance, and T is the torque developed by said drive means for said one axis.
Claim 13
Dependent Claim
153 words
The method of claim 8, wherein said command signal includes a component representing a desired position to which said arm is to be moved, said method including the steps of: generating a position feedback signal corresponding to the actual position of said arm in said one axis at a point between said compliance and said drive means for said one axis; developing a quantity corresponding to the component of position lost in said compliance during movement of said arm in said one axis; utilizing said actual position feedback signal and said said lost position quantity to provide a synthetic position feedback signal representing the actual position of said arm in said one axis at a point between said compliance and the outer end of said arm; and controlling movement of said manipulator arm in said one axis in accordance with said position component of said command signal and said synthetic position feedback signal.
Claim 14
Dependent Claim
51 words
The method of claim 10, wherein said synthetic position feedback signal is equal to θ 1 -T/K 1 , where θ 1 is said actual position feedback signal, K 1 is the spring rate of said compliance, and T is the torque developed by said drive means for said one axis.
Claim 15
Dependent Claim
41 words
The method of claim 8, wherein said command signal includes a controlled deceleration characteristic portion as the arm approaches said predetermined location so that most of the energy stored in said compliance is dissipated before the arm reaches said predetermined location.
Claim 16
Dependent Claim
21 words
The method of claim 12, wherein said controlled deceleration characteristic causes said arm to decrease at a constant rate of deceleration.
Claim 17
Dependent Claim
33 words
The method of claim 8, wherein said command signal comprises a velocity profile representing a desired variation in the velocity of said arm in said one axis during movement to said predetermined location.
Claim 18
Dependent Claim
40 words
The method of claim 14, wherein said velocity profile includes a controlled deceleration portion as the arm approaches said predetermined location so that most of the energy stored in said compliance is dissipated before the arm reaches said predetermined location.
Claim 19
Dependent Claim
29 words
The method of claim 15, wherein said controlled deceleration portion produces a linear decrease in the rate of deceleration of said arm as said arm approaches said predetermined location.
Claim 20
Dependent Claim
161 words
A control system for a programmable manipulator having a manipulator arm and drive means for moving said arm in a plurality of axes, said arm having support structure which includes compliance in at least one of said axes intermediate the outer end of said arm and the drive means for said one axis, comprising: means for generating a velocity feedback signal corresponding to the actual velocity of said manipulator arm in said one axis at a point between said compliance and said drive means for said one axis, means for devloping a quantity representing the portion of said actual velocity which is lost in said compliance during movement of said arm in said one axis; and means responsive to said velocity feedback signal and said quantity representing said lost velocity for developing a synthetic velocity feedback signal representing the velocity of said manipulator arm in said one axis at a point between said compliance and the outer end of said arm.
Claim 21
Dependent Claim
161 words
A control system for a programmable manipulator having a manipulator arm and drive means for moving said arm in a plurality of axes, said arm having support structure which includes compliance in at least one of said axes intermediate the outer end of said arm and the drive means for said one axis, comprising: means for generating a velocity feedback signal corresponding to the actual velocity of said manipulator arm in said one axis at a point between said compliance and said drive means for said one axis, means for devloping a quantity representing the portion of said actual velocity which is lost in said compliance during movement of said arm in said one axis; and means responsive to said velocity feedback signal and said quantity representing said lost velocity for developing a synthetic velocity feedback signal representing the velocity of said manipulator arm in said one axis at a point between said compliance and the outer end of said arm.
Claim 22
Dependent Claim
43 words
The control system of claim 17, which includes means for providing a command signal representing a desired velocity of movement of said arm, and servo loop means responsive to said command signal and said synthetic velocity feedback signal for controlling said drive means.
Claim 23
Dependent Claim
34 words
The control system of claim 18, wherein said command signal comprises a velocity profile representing a desired variation in the velocity of said arm in said one axis during movement to a predetermined location.
Claim 24
Dependent Claim
43 words
The control system of claim 19, wherein said velocity profile includes a controlled deceleration portion as the arm approaches said predetermined location so that most of the energy stored in said compliance is dissipated at the time said arm reaches said predetermined location.
Claim 25
Dependent Claim
34 words
The control system of claim 20, wherein said controlled deceleration portion of said velocity profile produces a linear decrease in the rate of deceleration of said arm as said arm approaches said predetermined location.
Claim 26
Dependent Claim
187 words
A control system for a programmable manipulator having a manipulator arm and drive means for moving said arm in a plurality of axes, said arm having support structure which includes compliance in at least one of said axes intermediate the outer end of said arm and the drive means for said one axis, said support structure having a relatively low first anti-resonant frequency due to said compliance, comprising: means for generating a velocity feedback signal corresponding to the actual velocity of said manipulator arm in said one axis at a point between said compliance and said drive means for said one axis, means responsive to said actual velocity feedback signal for developing a quantity representing the actual velocity of said arm in said one axis at a point between said compliance and the outer end of said arm, and servo-loop means for controlling said drive means for said one axis in accordance with an input command signal and employing said quantity as a synthetic velocity feedback signal, whereby the bandwidth of said servo loop means may be increased above said first anti-resonant frequency of said support structure.
Claim 27
Dependent Claim
187 words
A control system for a programmable manipulator having a manipulator arm and drive means for moving said arm in a plurality of axes, said arm having support structure which includes compliance in at least one of said axes intermediate the outer end of said arm and the drive means for said one axis, said support structure having a relatively low first anti-resonant frequency due to said compliance, comprising: means for generating a velocity feedback signal corresponding to the actual velocity of said manipulator arm in said one axis at a point between said compliance and said drive means for said one axis, means responsive to said actual velocity feedback signal for developing a quantity representing the actual velocity of said arm in said one axis at a point between said compliance and the outer end of said arm, and servo-loop means for controlling said drive means for said one axis in accordance with an input command signal and employing said quantity as a synthetic velocity feedback signal, whereby the bandwidth of said servo loop means may be increased above said first anti-resonant frequency of said support structure.
Claim 28
Dependent Claim
45 words
The control system of claim 22, which includes means for generating a drive signal corresponding to the torque developed by said drive means for said one axis, and means jointly responsive to said actual velocity feedback signal and said drive signal for devloping said quantity.
Claim 29
Dependent Claim
49 words
The control system of claim 23 wherein said quantity is proportional to θ 1 -1/K 1 (d/dt)(T), where θ 1 is said actual velocity feedback signal, K 1 is the spring rate of said compliance, and T is the torque developed by said drive means for said one axis.
Claim 30
Dependent Claim
110 words
The control system of claim 22, wherein said command signal includes a component representing a desired position to which said arm is to be moved, means for generating a position feedback signal corresponding to the actual position of said arm in said one axis at a point between said compliance and said drive means for said one axis, means responsive to said actual position signal for developing a further quantity representing the actual position of said arm in said axis at a point between said compliance and the outer end of said arm, and means utilizing said further quantity in said servo loop means as a synthetic position feedback signal.
Claim 31
Dependent Claim
50 words
The control system of claim 25, wherein said further quantity is equal to θ 1 -T/K 1 , where θ 1 is said actual position feedback signal, K 1 is the spring rate of said compliance, and T is the torque developed by said drive means for said one axis.
References Cited (Backward Citations)
US4219766A
Cited
US4362978A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1989-07-28 | 1990-01-27 | 1990-07-29 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1993-07-28 | 1994-01-27 | 1994-07-29 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 1997-07-28 | 1998-01-27 | 1998-07-29 | $7700.00 | Window Closed / Lapsed |