US4362978A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Control system for manipulator apparatus
Assignee: Unimation Inc
•
Filing: 1980-10-27
•
Granted: 1982-12-07
•
Expires: 2000-10-27
Abstract
Abstract A control system is provided for a programmable manipulator having an arm movable in a plurality of axes that results in improved dynamic performance and control of a manipulator arm over a wide range of arm loads, dynamic operating parameters of the arm, and over the full range of arm operating positions. The control system for one or more of the controlled axes includes several servo control loops utilizing force or pressure feedback from the axis actuators and variable inertia scaling of selected loop command signals and loop parameters. The variable inertia scaling in accordance with the inertia of the arm provides improved dynamic performance of the manipulator arm while maintaining stable servo-loop operation over a wide range of operating parameters. In a preferred arrangement, the variable inertia scaling is accomplished by the use of a look up table with appropriate interpolation of the table entries. The look up table is stored in a digital axis processor with the appropriate variable inertia scaling factors being determined by the axis processor for use by the respective axis servo-loop. The look up table in accordance with various predetermined operating requirements of the manipulator apparatus includes data entries representing inertia scaling factors according to the mass of the arm load, the commanded velocity in a particular axis, and the operating positions of one or more of the major control axes of the arm.
Inventors
- 👤 Brian W. Pollard
- 👤 William Perzley
- 👤 Stanley J. Blanchard
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-30 17:34
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/10; B25J9/14; B25J13/00; B25J13/08; B25J13/088; B25J17/00; B25J17/02; B25J17/0241; B25J17/025; G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/414; G05B19/4141; G05B2219/00; G05B2219/30; G05B2219/33; G05B2219/33337; G05B2219/37; G05B2219/37357; G05B2219/37388; G05B2219/39; G05B2219/39178; G05B2219/41; G05B2219/41309; G05B2219/42; G05B2219/42171; G05B2219/45; G05B2219/45083
Claims Analysis
Total Claims: 26
Claim 1
Independent Claim
136 words
A control system for a manipulator having an arm movable in a plurality of axes and including control apparatus that provides position error, velocity and acceleration command signals in response to program data and arm position data, said manipulator arm performing a work cycle in accordance with said program data and said position error, velocity and acceleration command signals, said control system comprising: means for inertia scaling one or more of said position error and acceleration command signals in accordance with scale factors representing the variation of the inertia of said arm over said work cycle; means responsive to said inertia scaled command signals and said command signals not scaled for variations in inertia for generating axes control signals; and means responsive to said axes control signals for moving said arm in said plurality of axes.
Claim 2
Dependent Claim
136 words
A control system for a manipulator having an arm movable in a plurality of axes and including control apparatus that provides position error, velocity and acceleration command signals in response to program data and arm position data, said manipulator arm performing a work cycle in accordance with said program data and said position error, velocity and acceleration command signals, said control system comprising: means for inertia scaling one or more of said position error and acceleration command signals in accordance with scale factors representing the variation of the inertia of said arm over said work cycle; means responsive to said inertia scaled command signals and said command signals not scaled for variations in inertia for generating axes control signals; and means responsive to said axes control signals for moving said arm in said plurality of axes.
Claim 3
Dependent Claim
19 words
The control system of claim 1 wherein said scaling means is responsive to the work load on said arm.
Claim 4
Dependent Claim
25 words
The control systems of claim 2 wherein said program data includes arm load data representing the work load on said arm throughout said work cycle.
Claim 5
Dependent Claim
36 words
The control system of claim 3 wherein said arm load data includes the load state defining whether a load is on or off said arm and data representing the mass of said load on said arm.
Claim 6
Dependent Claim
27 words
The control system of claim 1 wherein said scaling means is responsive to the position of said arm in one or more of said plurality of axes.
Claim 7
Dependent Claim
30 words
The control system of claims 2, 3 or 4 wherein said scaling means includes look-up table means for determining said scale factor in accordance with the inertia of said arm.
Claim 8
Dependent Claim
39 words
The control system of claim 6 wherein said look-up table includes a plurality of scale factors determined by the work load on said arm and the position of said arm in one or more of said plurality of axes.
Claim 9
Dependent Claim
36 words
The control system of claim 1 further comprising means for developing feedback signals representing the position and velocity of said arm and the force on said arm in one or more of said plurality of axes.
Claim 10
Dependent Claim
38 words
The control system of claim 8 wherein said axes control signal generating means comprises servo loop control means responsive to said feedback signals and said scaled command signals and said command signals not scaled for variations in inertia.
Claim 11
Dependent Claim
41 words
The control system of claim 9 wherein said arm moving means comprises hydraulically controlled actuators for one or more of said plurality of axes, said feedback developing means comprising means for sensing the pressure on one or more of said actuators.
Claim 12
Dependent Claim
38 words
The control system of claim 10 wherein one or more of said actuators are double acting actuators and said pressure sensing means comprising means for sensing the differential pressure across one or more of said double acting actuators.
Claim 13
Independent Claim
75 words
A method for controlling the movement of a movable member comprising the steps of: generating command signals representing the desired movement of said member; scaling one or more of said generated command signals in accordance with scale factors representing the variation in inertia of said member over the various controlled movements of said members; and moving said member in accordance with said scaled command signals and said command signals not scaled for variations in inertia.
Claim 14
Independent Claim
75 words
A method for controlling the movement of a movable member comprising the steps of: generating command signals representing the desired movement of said member; scaling one or more of said generated command signals in accordance with scale factors representing the variation in inertia of said member over the various controlled movements of said members; and moving said member in accordance with said scaled command signals and said command signals not scaled for variations in inertia.
Claim 15
Dependent Claim
24 words
The method of claim 12 wherein said moving step is further accomplished in accordance with feedback signals representing the dynamic movement of said member.
Claim 16
Dependent Claim
19 words
The method of claim 13 wherein said dynamic movement of said member includes the force experienced by said member.
Claim 17
Dependent Claim
289 words
A control system for a manipulator having an arm movable in a plurality of axes and including control apparatus that provides position error, velocity and acceleration command signals in response to program data and arm position data, said manipulator arm performing a work cycle in accordance with said program data and said position error, velocity and acceleration command signals, said control system comprising: means for inertia scaling one or more of said position error and acceleration command signals in accordance with scale factors representing the variation of the inertia of said arm over said work cycle; means responsive to said inertia scaled command signals and said command signals not scaled for variations in inertia for generating axes control signals; means responsive to said axes control signals for moving said arm in said plurality of axes; and means for developing feedback signals representing the position and velocity of said arm and the force on said arm in one or more of said plurality of axes, said axes control signal generating means comprising servo loop control means responsive to said feedback signals and said scaled command signals and said command signals not scaled for variations in inertia, said arm moving means comprising an electrically controlled hydraulic valve for one or more of said axes, each of said hydraulic valves having an overlapping center range of valve movement in which the valve does not provide control output characteristics, said servo loop control means further comprising valve threshold offset actuating means for developing an offset actuating signal of appropriate polarity to said valve independent of said respective axis control signal and in response to the respective axis control signal being less than or greater than zero for said axis controlled by said valve.
Claim 18
Dependent Claim
289 words
A control system for a manipulator having an arm movable in a plurality of axes and including control apparatus that provides position error, velocity and acceleration command signals in response to program data and arm position data, said manipulator arm performing a work cycle in accordance with said program data and said position error, velocity and acceleration command signals, said control system comprising: means for inertia scaling one or more of said position error and acceleration command signals in accordance with scale factors representing the variation of the inertia of said arm over said work cycle; means responsive to said inertia scaled command signals and said command signals not scaled for variations in inertia for generating axes control signals; means responsive to said axes control signals for moving said arm in said plurality of axes; and means for developing feedback signals representing the position and velocity of said arm and the force on said arm in one or more of said plurality of axes, said axes control signal generating means comprising servo loop control means responsive to said feedback signals and said scaled command signals and said command signals not scaled for variations in inertia, said arm moving means comprising an electrically controlled hydraulic valve for one or more of said axes, each of said hydraulic valves having an overlapping center range of valve movement in which the valve does not provide control output characteristics, said servo loop control means further comprising valve threshold offset actuating means for developing an offset actuating signal of appropriate polarity to said valve independent of said respective axis control signal and in response to the respective axis control signal being less than or greater than zero for said axis controlled by said valve.
Claim 19
Dependent Claim
297 words
A control system for a manipulator having an arm movable in a plurality of axes and including control apparatus that provides position error, velocity and acceleration command signals in response to program data and arm position data, said manipulator arm performing a work cycle in accordance with said program data and said position error, velocity and acceleration command signals, said control system comprising: means for inertia scaling one or more of said position error and acceleration command signals in accordance with scale factors representing the variation of the inertia of said arm over said work cycle; means responsive to said inertia scaled command signals and said command signals not scaled for variations in inertia for generating axes control signals; means responsive to said axes control signals for moving said arm in said plurality of axes; and means for developing feedback signals representing the position and velocity of said arm and the force on said arm in one or more of said plurality of axes, said axes control signal generating means comprising servo loop control means responsive to said feedback signals and said scaled command signals and said command signals not scaled for variations in inertia, said servo loop control means for at least one of said axes further comprising shunt control means responsive to said respective axis velocity command signal and said respective axis position error command signal for providing a shunt signal directly to said arm moving means independent of said respective axis command signal and in addition to said axis control signal for said respective axis, said shunt control means being active to provide said shunt signal whenever said velocity command signal is below a predetermined level, said shunt control means including means for amplifying said position error command signal to provide said shunt signal.
Claim 20
Dependent Claim
297 words
A control system for a manipulator having an arm movable in a plurality of axes and including control apparatus that provides position error, velocity and acceleration command signals in response to program data and arm position data, said manipulator arm performing a work cycle in accordance with said program data and said position error, velocity and acceleration command signals, said control system comprising: means for inertia scaling one or more of said position error and acceleration command signals in accordance with scale factors representing the variation of the inertia of said arm over said work cycle; means responsive to said inertia scaled command signals and said command signals not scaled for variations in inertia for generating axes control signals; means responsive to said axes control signals for moving said arm in said plurality of axes; and means for developing feedback signals representing the position and velocity of said arm and the force on said arm in one or more of said plurality of axes, said axes control signal generating means comprising servo loop control means responsive to said feedback signals and said scaled command signals and said command signals not scaled for variations in inertia, said servo loop control means for at least one of said axes further comprising shunt control means responsive to said respective axis velocity command signal and said respective axis position error command signal for providing a shunt signal directly to said arm moving means independent of said respective axis command signal and in addition to said axis control signal for said respective axis, said shunt control means being active to provide said shunt signal whenever said velocity command signal is below a predetermined level, said shunt control means including means for amplifying said position error command signal to provide said shunt signal.
Claim 21
Independent Claim
157 words
A method for controlling a manipulator arm movable in a plurality of axes comprising the steps of: generating acceleration/torque command signals for one or more of said axes in response to stored program data representing a taught work cycle; modifying said generated acceleration/torque command signals in one or more of said axes in accordance with the changes in the effective inertia of said manipulator arm in one or more of said axes as the inertia of said manipulator arm varies during said work cycle in one or more of said axes; and controlling the movement of said manipulator arm in one or more of said axes in accordance with said modified acceleration/torque command signals and dynamic feedback signals representing the inertial mass system of said manipulator arm to provide the desired torque to said manipulator arm in one or more of said axes in accordance with said effective inertia of said manipulator arm throughout said work cycle.
Claim 22
Independent Claim
157 words
A method for controlling a manipulator arm movable in a plurality of axes comprising the steps of: generating acceleration/torque command signals for one or more of said axes in response to stored program data representing a taught work cycle; modifying said generated acceleration/torque command signals in one or more of said axes in accordance with the changes in the effective inertia of said manipulator arm in one or more of said axes as the inertia of said manipulator arm varies during said work cycle in one or more of said axes; and controlling the movement of said manipulator arm in one or more of said axes in accordance with said modified acceleration/torque command signals and dynamic feedback signals representing the inertial mass system of said manipulator arm to provide the desired torque to said manipulator arm in one or more of said axes in accordance with said effective inertia of said manipulator arm throughout said work cycle.
Claim 23
Dependent Claim
49 words
The method of claim 17 wherein said manipulator arm includes hudraulically controlled actuators for said one or more of said axes, said controlling step further comprising the step of providing a sensed pressure signal representing the pressure on said one or more controlled actuators as said dynamic feedback signals.
Claim 24
Dependent Claim
192 words
A control system for a manipulator having an arm movable in a plurality of axes, said control system comprising: means for generating acceleration/torque command signals for one or more of said axes in response to stored program data representing a taught work cycle; means for defining the effective inertia throughout said work cycle of said manipulator arm in one or more of said axes as said arm moves to perform said work cycle; means responsive to said inertia defining means and said acceleration/torque command signal generating means for modifying said acceleration/torque command signals in accordance with the changes in effective inertia of said manipulator arm during said work cycle; means for providing dynamic feedback signals for one or more of said axes representing the inertial mass system of said manipulator arm; and servo loop control means responsive to said dynamic feedback signals and said modified acceleration/torque command signals for controlling movement of said manipulator arm in one or more of said axes to provide the desired torque to said manipulator arm in one or moe of said axes in accordance with said effective inertia of said manipulator arm throughout said work cycle.
Claim 25
Dependent Claim
192 words
A control system for a manipulator having an arm movable in a plurality of axes, said control system comprising: means for generating acceleration/torque command signals for one or more of said axes in response to stored program data representing a taught work cycle; means for defining the effective inertia throughout said work cycle of said manipulator arm in one or more of said axes as said arm moves to perform said work cycle; means responsive to said inertia defining means and said acceleration/torque command signal generating means for modifying said acceleration/torque command signals in accordance with the changes in effective inertia of said manipulator arm during said work cycle; means for providing dynamic feedback signals for one or more of said axes representing the inertial mass system of said manipulator arm; and servo loop control means responsive to said dynamic feedback signals and said modified acceleration/torque command signals for controlling movement of said manipulator arm in one or more of said axes to provide the desired torque to said manipulator arm in one or moe of said axes in accordance with said effective inertia of said manipulator arm throughout said work cycle.
Claim 26
Dependent Claim
41 words
The control system of claim 19 wherein said manipulator arm comprises a hydraulic actuator for one or more of said axes and said dynamic feedback signal providing means comprises means for sensing the pressure on said one or more controlled actuators.
References Cited (Backward Citations)
US154439A
Cited
US3661051A
Cited
US4156835A
Cited
US4086522A
Cited
US4132937A
Cited
US4243923A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1985-12-06 | 1986-06-07 | 1986-12-07 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1989-12-06 | 1990-06-07 | 1990-12-07 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 1993-12-06 | 1994-06-07 | 1994-12-07 | $7700.00 | Window Closed / Lapsed |