US4132937A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Programmable manipulator with dynamic feedback apparatus for stabilization
Assignee: Unimation Inc
•
Filing: 1976-10-18
•
Granted: 1979-01-02
•
Expires: 1996-10-18
Abstract
Abstract A programmable manipulator apparatus having an arm movable in a plurality of axes employs a feedback signal representing the dynamic behavior of the end of the manipulator arm for use in stabilizing a positional servo loop especially where the position sensing is performed at a location on the manipulator apparatus which is physically closer to the drive apparatus than the end of the arm. The manipulator apparatus includes encoders for developing position signals representing the position of the manipulator in each of the axes which are stored in a memory. The stored digital signals are utilized as command signals and are compared with the encoder signals to develop an error signal utilized to control movement of the manipulator apparatus. The dynamic feedback signal is selectively combined with the positional error signal in a predetermined manner to stabilize the control and operation of the manipulator arm by providing a high negative dynamic feedback signal during deceleration and a low signal during the acceleration phase thereby avoiding conflict between the positional error signal and the dynamic feedback signals.
Inventors
- 👤 Joseph F. Engelberger
- 👤 Maurice J. Dunne
- 👤 Peter F. Rogers
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-25 11:45
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/19; G05B19/27; G05B19/31; G05B19/311; G05B19/318; B; B25; B25J; B25J9/00; B25J9/16; B25J9/1602; B25J9/161; G05B19/42; G05B2219/00; G05B2219/30; G05B2219/37; G05B2219/37388
Claims Analysis
Total Claims: 33
Claim 1
Independent Claim
158 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the acceleration in at least one of said independent axes at a location on said manipulator arm closer to the outer end of said manipulator arm than the location at which the encoder for said axis measures positional data and for generating a dynamic feedback signal related to the acceleration in said axis, and means for combining said error signal and said dynamic feedback signal to control said moving means.
Claim 2
Dependent Claim
158 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the acceleration in at least one of said independent axes at a location on said manipulator arm closer to the outer end of said manipulator arm than the location at which the encoder for said axis measures positional data and for generating a dynamic feedback signal related to the acceleration in said axis, and means for combining said error signal and said dynamic feedback signal to control said moving means.
Claim 3
Dependent Claim
61 words
The combination of claim 1 wherein said sensing and generating means includes accelerometer means for providing an acceleration signal and means responsive to said acceleration signal and said error signal for producing said dynamic feedback signal, said dynamic feedback signal increasing in magnitude with an increase in said acceleration signal and increasing in magnitude with a decrease in said error signal.
Claim 4
Dependent Claim
18 words
The combination of claim 1 wherein said dynamic feedback signal is proportional to the acceleration in said axis.
Claim 5
Dependent Claim
17 words
The combination of claim 2 wherein said acceleration signal is proportional to the acceleration in said axis.
Claim 6
Dependent Claim
17 words
The combination of claim 1 wherein said dynamic feedback signal is inversely proportional to said error signal.
Claim 7
Dependent Claim
147 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the velocity in at least one of said independent axes at a location on said manipulator arm than the location at which the encoder for said axis is positioned and for generating a dynamic feedback signal related to the acceleration in said axis, and means controlling said moving means for combining said error signal and said dynamic feedback signal.
Claim 8
Dependent Claim
147 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the velocity in at least one of said independent axes at a location on said manipulator arm than the location at which the encoder for said axis is positioned and for generating a dynamic feedback signal related to the acceleration in said axis, and means controlling said moving means for combining said error signal and said dynamic feedback signal.
Claim 9
Dependent Claim
146 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the dynamic behavior of at least one axis of said independent axes at a location on said manipulator arm physically closer to the outer end of said manipulator arm than the location at which the encoder for said axis is positioned, and means responsive to said dynamic sensing means and said error signal for controlling said moving means.
Claim 10
Dependent Claim
146 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the dynamic behavior of at least one axis of said independent axes at a location on said manipulator arm physically closer to the outer end of said manipulator arm than the location at which the encoder for said axis is positioned, and means responsive to said dynamic sensing means and said error signal for controlling said moving means.
Claim 11
Dependent Claim
206 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the acceleration in at least one of said independent axes at a location on said manipulator arm closer to the outer end of said manipulator arm than the location at which the encoder for said axis measures positional data; function generator means responsive to said error signal; and multiplying digital to analog converter means having the output of said acceleration sensing means as a variable reference input and the output of said function generator means as a digital input, the analog output of said multiplying digital to analog converter providing a dynamic feedback signal which increases in magnitude with an increase in the output of said acceleration sensing means and increases with a decrease in said error signal.
Claim 12
Dependent Claim
206 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for sensing the acceleration in at least one of said independent axes at a location on said manipulator arm closer to the outer end of said manipulator arm than the location at which the encoder for said axis measures positional data; function generator means responsive to said error signal; and multiplying digital to analog converter means having the output of said acceleration sensing means as a variable reference input and the output of said function generator means as a digital input, the analog output of said multiplying digital to analog converter providing a dynamic feedback signal which increases in magnitude with an increase in the output of said acceleration sensing means and increases with a decrease in said error signal.
Claim 13
Dependent Claim
15 words
The combination of claim 8 wherein said function generator means performs a binary complementary function.
Claim 14
Dependent Claim
23 words
The combination of claim 8 wherein a bandpass filter stage is provided between said accelerometer means and said dynamic feedback signal generating means.
Claim 15
Dependent Claim
206 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, tachometer means for sensing the velocity in at least one of said independent axes at a location on said manipulator arm physically closer to the outer end of said manipulator arm than the location at which the encoder for said axis is positioned and providing an electrical velocity signal; means for differentiating said velocity signal to provide an acceleration signal proportional to the acceleration in said one axis; means for combining said acceleration signal and said error signal to provide a dynamic feedback signal which increases in magnitude with a decrease in said error signal and also increases in magnitude with an increase in said acceleration signal; and means for controlling said moving means in accordance with said dynamic feedback signal.
Claim 16
Dependent Claim
206 words
In a programmable manipulator, the combination of, a manipulator arm, means for moving said arm to different positions in a plurality of independent axes, memory storage means for storing digital representations corresponding to different positions of said arm in said axes, encoder means for each of said axes and operative to develop position signals corresponding to the actual position of said arm in said plurality of axes, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, tachometer means for sensing the velocity in at least one of said independent axes at a location on said manipulator arm physically closer to the outer end of said manipulator arm than the location at which the encoder for said axis is positioned and providing an electrical velocity signal; means for differentiating said velocity signal to provide an acceleration signal proportional to the acceleration in said one axis; means for combining said acceleration signal and said error signal to provide a dynamic feedback signal which increases in magnitude with a decrease in said error signal and also increases in magnitude with an increase in said acceleration signal; and means for controlling said moving means in accordance with said dynamic feedback signal.
Claim 17
Dependent Claim
66 words
The combination of claim 11 wherein said dynamic feedback signal producing means includes function generator means responsive to said error signal and multiplying digital to analog converter means having a variable reference input responsive to said differetiator means and the output of said function generator means as a digital input, said converted analog output of said multiplying digital to analog converter providing said dynamic feedback signal.
Claim 18
Dependent Claim
15 words
The combination of claim 12 wherein said function generator means perform a binary complementary function.
Claim 19
Dependent Claim
24 words
The combination of claim 12 wherein a bandpass filter stage is provided between said differentiator means and said multiplying digital to analog converter means.
Claim 20
Dependent Claim
17 words
The combination of claim 11 wherein said velocity signal is proportional to the velocity in said axis.
Claim 21
Dependent Claim
18 words
The combination of claim 11 wherein said dynamic feedback signal is proportional to the acceleration in said axis.
Claim 22
Dependent Claim
17 words
The combination of claim 11 wherein said dynamic feedback signal is inversely proportional to said error signal.
Claim 23
Dependent Claim
159 words
A control circuit for use with an apparatus which utilizes indirect position sensing to control the operation of said apparatus at a location physically remote from the point of position sensing, said control circuit comprising: means for developing an indirect position sensing signal; means including accelerometer means for sensing the dynamic behaviour of said apparatus at said remote location and providing an acceleration signal; means for generating a dynamic feedback signal related to the dynamic behaviour at said remote location and including function generator means responsive to said indirect position sensing signal and multiplying digital to analog converter means; said multiplying digital to analog converter means having said acceleration signal as a variable reference input and the output of said function generator means as a digital input and providing said dynamic feedback signal at the analog output thereof; and means for combining said dynamic feedback signal and said indirect position sensing signal to control the operation of said apparatus.
Claim 24
Dependent Claim
159 words
A control circuit for use with an apparatus which utilizes indirect position sensing to control the operation of said apparatus at a location physically remote from the point of position sensing, said control circuit comprising: means for developing an indirect position sensing signal; means including accelerometer means for sensing the dynamic behaviour of said apparatus at said remote location and providing an acceleration signal; means for generating a dynamic feedback signal related to the dynamic behaviour at said remote location and including function generator means responsive to said indirect position sensing signal and multiplying digital to analog converter means; said multiplying digital to analog converter means having said acceleration signal as a variable reference input and the output of said function generator means as a digital input and providing said dynamic feedback signal at the analog output thereof; and means for combining said dynamic feedback signal and said indirect position sensing signal to control the operation of said apparatus.
Claim 25
Dependent Claim
80 words
The combination of claim 18 wherein said sensing means includes tachometer means, said generating means includes differentiator means for providing an acceleration signal and said dynamic feedback signal means includes function generator means responsive to said indirect position sensing signal and multiplying digital to analog converter means having said acceleration signal as a variable reference input and the output of said function generator means as a digital input, said multiplying digital to analog converter means providing said dynamic feedback signal.
Claim 26
Dependent Claim
136 words
In a programmable manipulator, the combination of a manipulator arm, means for moving said arm in a plurality of independent axes, means for developing a series of command signals representing different positions of said arm in said axes, encoder means for measuring the actual position of said arm in said plurality of axes and developing position signals corresponding thereto, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for developing an acceleration signal proportional to the rate of change of velocity in one of said axes, means for modifying said acceleration signal in accordance with the value of said error signal in said one axis, and means for combining said error signal and said modified acceleration signal to control said moving means in said one axis.
Claim 27
Dependent Claim
136 words
In a programmable manipulator, the combination of a manipulator arm, means for moving said arm in a plurality of independent axes, means for developing a series of command signals representing different positions of said arm in said axes, encoder means for measuring the actual position of said arm in said plurality of axes and developing position signals corresponding thereto, comparing means for comparing command and position signals and developing an error signal related to the difference therebetween, means for developing an acceleration signal proportional to the rate of change of velocity in one of said axes, means for modifying said acceleration signal in accordance with the value of said error signal in said one axis, and means for combining said error signal and said modified acceleration signal to control said moving means in said one axis.
Claim 28
Dependent Claim
24 words
The combination of claim 20, wherein said acceleration signal is varied inversely with respect to said error signal to provide said modified acceleration signal.
Claim 29
Dependent Claim
44 words
The combination of claim 20, which includes acceleration sensing means mounted on said arm to measure the acceleration in said one axis closer to the outer end thereof than measurement of the position of said arm in said one axis by said encoder means.
Claim 30
Dependent Claim
39 words
The combination of claim 22, wherein said acceleration sensing means includes means for developing a signal proportional to the velocity of said arm in said one axis, and means for differentiating said velocity signal to provide said acceleration signal.
Claim 31
Dependent Claim
49 words
The combination of claim 20, which includes a manipulator hand connected to the outer end of said arm and movable in a plurality of axes with respect to said outer end of said arm, said plurality of axes including said one axis for which said acceleration signal is developed.
Claim 32
Dependent Claim
61 words
The combination of claim 24, wherein said encoder means for said one axis is mounted on said arm remote from said free end thereof and said acceleration sensing means includes means for developing a velocity signal proportional to the velocity of movement of said hand in said one axis, and means for differentiating said velocity signal to provide said acceleration signal.
Claim 33
Dependent Claim
43 words
The combination of claim 25, wherein said manipulator hand includes first and second parts movable with respect to each other, and said velocity signal developing means includes a tachometer mounted on one of said parts for measuring the velocity of the other part.
References Cited (Backward Citations)
US3512060A
Cited
US3648143A
Cited
US3906326A
Cited
US3727119A
Cited
US3777122A
Cited
US3934186A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1982-01-01 | 1982-07-03 | 1983-01-02 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1986-01-01 | 1986-07-03 | 1987-01-02 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 1990-01-01 | 1990-07-03 | 1991-01-02 | $7700.00 | Window Closed / Lapsed |