Patent US3570006A successfully refreshed from Google Patents.
US4510428A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Control system for manipulator apparatus with initializing stabilization and inertia scaling
Assignee: Unimation Inc
•
Filing: 1983-03-25
•
Granted: 1985-04-09
•
Expires: 2003-03-25
Abstract
Abstract A control system is provided for servo controlled apparatus such as a programmable manipulator having a manipulator arm movable in a plurality of axes. The control system provides improved dynamic performance and control of the manipulator arm over a wide range of arm loads, dynamic operating parameters of the arm and over the full range of operating positions. The control system for one or more of the controlled axes includes servo control loops utilizing various feedback signals. In one arrangement, an inertia correlated signal provided as a pressure signal from a hydraulic actuator of an appropriate axis is utilized in combination with a function generator circuit to provide variable inertial scaling of selected loop command signals. The axis utilized for the pressure signal is determined by the mounting of the manipulator apparatus so as to provide a signal correlated to the inertial mass system of the manipulator arm. A pressure signal from an actuator of an axis to be controlled is utilized to initialize the command signals for the axis upon power turn-on of the control system to provide stabilization of the manipulator arm during the power turn-on and initializing phase.
Inventors
- 👤 Maurice J. Dunne
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-24 23:01
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/19; G05B19/21; G05B19/23; G05B19/231; G05B19/237; B; B25; B25J; B25J9/00; B25J9/16; B25J9/1628; B25J9/1638; G05B2219/00; G05B2219/30; G05B2219/33; G05B2219/33337; G05B2219/37; G05B2219/37357; G05B2219/37388; G05B2219/39; G05B2219/39178; G05B2219/41; G05B2219/41309
Claims Analysis
Total Claims: 26
Claim 1
Independent Claim
94 words
A control system for manipulator apparatus having an arm movable in a plurality axes and including control apparatus that provides command signals in response to program data and arm position data, said control system comprising: means for providing a scaling signal derived from one or more of said axes and correlated to the inertial mass system of said arm; means responsive to said command signals and said scaling signal for modifying one or more of said command signals; and means responsive to said command signals for moving said arm in said plurality of axes.
Claim 2
Dependent Claim
94 words
A control system for manipulator apparatus having an arm movable in a plurality axes and including control apparatus that provides command signals in response to program data and arm position data, said control system comprising: means for providing a scaling signal derived from one or more of said axes and correlated to the inertial mass system of said arm; means responsive to said command signals and said scaling signal for modifying one or more of said command signals; and means responsive to said command signals for moving said arm in said plurality of axes.
Claim 3
Dependent Claim
49 words
The control system of claim 1 wherein said manipulator apparatus includes hydraulic actuator means for one or more of said axes and said control system further comprising means for sensing the pressure in one or more of said hydraulic actuators, said scaling signal being derived from said sensed pressure.
Claim 4
Dependent Claim
30 words
The control system of claim 2 wherein each of said actuators is a double acting actuator and said sensed pressure is a differential pressure across said respective double acting actuator.
Claim 5
Dependent Claim
39 words
The control system of claim 2 wherein the actuator for the axis that is used for pressure sensing for said scaling signal is determined such that the sensed pressure is correlated to the inertial mass system of said arm.
Claim 6
Dependent Claim
21 words
The control system of claim 1 wherein said sealing signal is a dynamic signal representing the dynamic inertia of said arm.
Claim 7
Dependent Claim
82 words
The control system of claim 1 wherein said manipulator arm is movable in a rotary axis for movement in a horizontal plane with respect to a base when said base is parallel to the ground plane, said arm being movable in a vertical axis for up-down movement with respect to said base, and in a radial extension axis for in-out movement, said scaling signal being correlated to inertia in said vertical axis when said base is mounted parallel to the ground plane.
Claim 8
Dependent Claim
41 words
The control system of claim 6 wherein said scaling signal is correlated to inertia in said radial extension axis when said manipulator apparatus is mounted with said base in a generally vertical plane and said radial extension axis is generally vertical.
Claim 9
Dependent Claim
40 words
The control system of claim 7 wherein said scaling signal is correlated to inertia in said rotary axis with said base being mounted in a generally vertical plane and said radial extension axis is generally parallel to the ground plane.
Claim 10
Dependent Claim
37 words
The control system of claim 8 wherein said command signal modifying means further comprises selectively operable means for selectively providing modification of said command signal in the correct direction correlated to the mounting of said manipulator apparatus.
Claim 11
Dependent Claim
29 words
The control system of claim 2 wherein said signal modifying means comprises square law function generator means for modifying said command signal as the square of the scaling signal.
Claim 12
Dependent Claim
48 words
The control system of claim 10 wherein said square law function generator means comprises a light emitting diode connected to said scaling signal and a photocell responsive to said light emitting diode, said command signal being connected in series with said photocell to provide said modified command signal.
Claim 13
Independent Claim
91 words
A method for scaling a command signal in a control system for a manipulator arm controllable in a plurality of axes in accordance with the inertial mass system of the controlled manipulator arm comprising the steps of: deriving a signal in one or more of the axes of the manipulator arm correlated to the inertial mass system of the arm; scaling a command signal in response to said inertial mass system correlated signal; and controlling the manipulator arm in said plurality of axes in accordance with said inertia scaled command signal.
Claim 14
Independent Claim
91 words
A method for scaling a command signal in a control system for a manipulator arm controllable in a plurality of axes in accordance with the inertial mass system of the controlled manipulator arm comprising the steps of: deriving a signal in one or more of the axes of the manipulator arm correlated to the inertial mass system of the arm; scaling a command signal in response to said inertial mass system correlated signal; and controlling the manipulator arm in said plurality of axes in accordance with said inertia scaled command signal.
Claim 15
Dependent Claim
192 words
A control system for manipulator apparatus having an arm movable in a plurality of axes comprising: servo loop control signal generating means for generating axis control signals for each of said axes in response to program data and feedback signals including arm position data derived from movement of said arm in said plurality of axes, at least one of said feedback signals for one of said axes being correlated to the inertial mass system of said arm and at least one of said axis control signals being provided by summing said inertial mass system correlated feedback signal and an axis command signal, said axis command signal being generated by said servo loop control signal generating means; means for providing said feedback signals; means responsive to said axis control signals for moving said arm in said plurality of axes; and means responsive to a servo enable signal for modifying said servo loop control signal generating means to provide for a predetermined period of time a command signal for one or more of said axes equal in magnitude and opposite in sign to said inertial mass system correlated feedback signal for said respective axis.
Claim 16
Dependent Claim
192 words
A control system for manipulator apparatus having an arm movable in a plurality of axes comprising: servo loop control signal generating means for generating axis control signals for each of said axes in response to program data and feedback signals including arm position data derived from movement of said arm in said plurality of axes, at least one of said feedback signals for one of said axes being correlated to the inertial mass system of said arm and at least one of said axis control signals being provided by summing said inertial mass system correlated feedback signal and an axis command signal, said axis command signal being generated by said servo loop control signal generating means; means for providing said feedback signals; means responsive to said axis control signals for moving said arm in said plurality of axes; and means responsive to a servo enable signal for modifying said servo loop control signal generating means to provide for a predetermined period of time a command signal for one or more of said axes equal in magnitude and opposite in sign to said inertial mass system correlated feedback signal for said respective axis.
Claim 17
Dependent Claim
68 words
The control system of claim 13 wherein said servo loop control signal generating means includes for at least one of said axes integration means providing an integration function after summation of said inertia correlated feedback signal and said axis command signal, said modifying means further comprising means for initializing said integrator function of said integrator in response to said servo enable signal for said predetermined period of time.
Claim 18
Dependent Claim
31 words
The control system of claim 14 wherein said servo enable signal is a power start up signal, said modifying means providing initializing stabilization for said arm and said arm moving means.
Claim 19
Dependent Claim
37 words
The control system of claim 13 wherein said arm moving means includes hydraulically operated actuators for one or more of said axes, said inertia correlated feedback signal being obtained as a sensed pressure signal from said actuator.
Claim 20
Dependent Claim
147 words
An initializing stabilization method for manipulator apparatus having an arm movable in a plurality of axes and control arrangements for providing control signals to arm moving arrangements in response to program data and arm feedback signals, the control arrangement for at least one of said axes including a force or pressure loop function, the force or pressure control loop function including an integrator function, the feedback signal in said at least one axis being correlated to the inertial mass system of said arm and being summed with a command signal prior to said integrator function, the output of said integrator function representing said control signal, the process comprising in response to an initializing signal providing for a predetermined stabilization time period a command signal equal in magnitude and opposite in sign to said inertia feedback signal and further eliminating said integrator function for said predetermined stabilization period.
Claim 21
Dependent Claim
147 words
An initializing stabilization method for manipulator apparatus having an arm movable in a plurality of axes and control arrangements for providing control signals to arm moving arrangements in response to program data and arm feedback signals, the control arrangement for at least one of said axes including a force or pressure loop function, the force or pressure control loop function including an integrator function, the feedback signal in said at least one axis being correlated to the inertial mass system of said arm and being summed with a command signal prior to said integrator function, the output of said integrator function representing said control signal, the process comprising in response to an initializing signal providing for a predetermined stabilization time period a command signal equal in magnitude and opposite in sign to said inertia feedback signal and further eliminating said integrator function for said predetermined stabilization period.
Claim 22
Dependent Claim
56 words
The method of claim 17 wherein said control arrangement for said at least one of said axes includes a velocity control loop function for providing said command signal, said velocity control loop function includes an integration function, said command signal being provided by initializing said velocity integrator function in accordance with said inertia correlated feedback signal.
Claim 23
Dependent Claim
25 words
The method of claim 17 wherein said initializing stabilization being provided for the axis or axes in which the manipulator arm is effected by gravity.
Claim 24
Dependent Claim
71 words
The method of claim 19 wherein said manipulator arm is rotatably mounted on a base for rotary axis movement in a horizontal plane with the base parallel to the ground plane, said arm further being mounted for vertical axis movement with respect to said base, said initializing stabilization method being provided in said vertical axis when said manipulator apparatus is mounted with said base being mounted parallel to the ground plane.
Claim 25
Dependent Claim
43 words
The method of claim 20 wherein said initializing stabilization method is provided in said rotary axis when said manipulator apparatus is mounted with said rotary axis movement being in a vertical plane and said manipulator arm extending generally parallel to the ground plane.
Claim 26
Dependent Claim
45 words
The method of claim 20 wherein said manipulator arm is mounted for radial extension axis movement and said initialization stabilization method is provided in said radial extension axis when said manipulator apparatus is mounted with said radial extension axis movement in a generally vertical direction.
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) | 1988-04-08 | 1988-10-08 | 1989-04-09 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1992-04-08 | 1992-10-08 | 1993-04-09 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 1996-04-08 | 1996-10-08 | 1997-04-09 | $7700.00 | Window Closed / Lapsed |