US4908556A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Modular robot control system
Assignee: Staeubli International AG
•
Filing: 1986-11-20
•
Granted: 1990-03-13
•
Expires: 2006-11-20
Abstract
Abstract A modular digital robot control includes an electronic arm interface board provided with circuitry for performing robot arm dependent functions. Included are circuitry for generating power amplifier control signals in response to input voltage command signals and circuitry for processing and manipulating position, velocity and motor current feedback signals. An electronic torque processor board is provided with paired torque microprocessors for operating each of respective torque control loops for respective robot joint motors. The torque microprocessors generate the voltage commands in response to input torque commands and feedback motor current signals. An electronic servo control board is provided with paired position/velocity microprocessors for operating position and velocity control loops for the respective joint motors. The position/velocity microprocessors generate the torque commands in response to input position commands and feedback position and velocity signals. The servo control board further includes system resource facilities providing general support for the operation of the microprocessors and includes a DMC controller and two asynchronous controllers for communications interfacing with local input/output devices and other systems and devices. When executed in one of the position/velocity microprocessors, a stored motion program uses trajectory planning and interpolation to generate position commands in accordance with predefined moves set forth in a robot program. The servo control, torque processor and arm interface boards are interconnected to provide a complete basic control for the robot joint motors. An optional fourth electronic board can be connected to the basic control. It is called a system board and it includes paired system microprocessors that execute the motion program enabling the expanded control to provide extended robot control performance.
Inventors
- 👤 Kenneth E. Daggett
- 👤 Eimei M. Onaga
- 👤 Richard J. Casler, Jr.
- 👤 Barrett L. Booth
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-30 03:59
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/414; G05B19/4141; G05B2219/00; G05B2219/30; G05B2219/31; G05B2219/31094; G05B2219/33; G05B2219/33053; G05B2219/33167; G05B2219/33169; G05B2219/33209; G05B2219/33337; G05B2219/34; G05B2219/34044; G05B2219/34076; G05B2219/34194; G05B2219/34196; G05B2219/34225; G05B2219/34428; G05B2219/35; G05B2219/35585; G05B2219/40; G05B2219/40523; G05B2219/42; G05B2219/42062; G05B2219/45; G05B2219/45083; Y; Y02; Y02P; Y02P90/00; Y02P90/02
Claims Analysis
Total Claims: 13
Claim 1
Independent Claim
295 words
A modular digital control for a robot having an arm with each of a plurality of joints driven by an electric motor in turn supplied with drive current by a power amplifier, said modular robot control comprising: an arm interface module having circuitry for performing robot arm dependent functions including circuit means for generating power amplifier control signals in response to input voltage command signals; said arm interface module circuitry further including circuit means for processing and manipulating position, velocity and motor current feedback signals; a torque processor module having torque microprocessor servo means for operating each of respective torque control loops for the respective joint motors; said torque microprocessor servo means generating said input voltage command signals in response to input torque commands and feedback motor current signals; a servo control module having position/velocity microprocessor servo means having digital signal processing capability for operating position and velocity control loops for the respective joint motors; said position/velocity microprocessor servo means generating said input torque commands in response to input position commands and said position and velocity feedback signals; said servo control module further including system resource means providing a hierarchical general support for the operation of said servo means and including data communicating control means for communications interfacing with local input/output devices and other systems and devices; program storage means for storing program means operative when executed to provide trajectory planning and interpolation and generate said input position commands in accordance with predefined moves set forth in a robot program; means for coupling said program storage means to said position/velocity microprocessor servo means to enable execution of said program means therein; and means for interconnecting said servo control, torque processor and arm interface modules to provide a complete basic control for said robot joint motors.
Claim 2
Dependent Claim
295 words
A modular digital control for a robot having an arm with each of a plurality of joints driven by an electric motor in turn supplied with drive current by a power amplifier, said modular robot control comprising: an arm interface module having circuitry for performing robot arm dependent functions including circuit means for generating power amplifier control signals in response to input voltage command signals; said arm interface module circuitry further including circuit means for processing and manipulating position, velocity and motor current feedback signals; a torque processor module having torque microprocessor servo means for operating each of respective torque control loops for the respective joint motors; said torque microprocessor servo means generating said input voltage command signals in response to input torque commands and feedback motor current signals; a servo control module having position/velocity microprocessor servo means having digital signal processing capability for operating position and velocity control loops for the respective joint motors; said position/velocity microprocessor servo means generating said input torque commands in response to input position commands and said position and velocity feedback signals; said servo control module further including system resource means providing a hierarchical general support for the operation of said servo means and including data communicating control means for communications interfacing with local input/output devices and other systems and devices; program storage means for storing program means operative when executed to provide trajectory planning and interpolation and generate said input position commands in accordance with predefined moves set forth in a robot program; means for coupling said program storage means to said position/velocity microprocessor servo means to enable execution of said program means therein; and means for interconnecting said servo control, torque processor and arm interface modules to provide a complete basic control for said robot joint motors.
Claim 3
Dependent Claim
24 words
A modular robot control as set forth in claim 1 wherein said program storage means includes memory means included in said system resource means.
Claim 4
Dependent Claim
71 words
A modular robot control as set forth in claim 2 wherein there is provided at least one system level module having system microprocessor means operative to execute said program means; and means for interconnecting said system level module with said position/velocity microprocessor servo module so as to couple said system resource means thereto and so as to enable said up position commands to be applied to said position/velocity microprocessor servo means.
Claim 5
Dependent Claim
57 words
A modular robot control as set forth in claim 3 wherein said arm interface module is embodied on a first electronc board; said torque processor module is embodied on a second electronic board; and said servo control module is embodied on a third electronic board and said system level module is embodied on a fourth electronic board.
Claim 6
Dependent Claim
74 words
A modular robot control as set forth in claim 3 wherein: each of said microprocessor servo means includes first and second microprocessors; said first microprocessor having relatively high data processing capability and said second microprocessor having relatively high computational capability; and means for coupling said first and second microprocessors in each microprocessor series means so as to enable said first microprocessor to manage the flow of input/output data to and from said second microprocessor.
Claim 7
Dependent Claim
98 words
A modular robot control as set forth in claim 1 wherein said generating circuit means in said arm interface module generates said power amplifier control signals for said power amplifiers supplying brushless DC joint motors or for said power amplifiers supplying brush type DC motors according to the type of motors provided on the robot; and said processing and manipulating circuit means in said arm interface module includes means for generating position and velocity feedback signals from incremental motor position sensors or for processing position and velocity feedback signals respectively from absolute motor position sensors and motor tachometers.
Claim 8
Dependent Claim
45 words
A modular robot control as set forth in claim 1 wherein said arm interface module is embodied on a first electronic board; said torque processor module is embodied on a second electronic board; and said position/velocity servo module is embodied on a third electronic board.
Claim 9
Dependent Claim
98 words
A modular robot control as set forth in claim 5 wherein: said generating circuit means in said arm interface module generates said power amplifier control signals for said power amplifiers supplying brushless DC joint motors or for said power amplifiers supplying brush type DC motors according to the type of motors provided on the robot; and said processing and manipulating circuit means in said arm interface module includes means for generating position and velocity feedback signals from incremental motor position sensors or for processing position and velocity feedback signals respectively from absolute motor position sensors and motor tachometers.
Claim 10
Dependent Claim
26 words
A modular robot control as set forth in claim 8 wherein said generating circuit means on said arm interface board includes a pulse width generator circuit.
Claim 11
Dependent Claim
24 words
A modular robot control as set forth in claim 8 wherein said arm interface module further includes circuit means for processing feedback current signals.
Claim 12
Dependent Claim
311 words
A module digital control for a robot having an arm with each of a plurality of joints driven by an electric motor in turn supplied with drive current by a power amplifier, said modular robot control being implemented by a hierarchical set of functionally integrated modules, comprising: an arm interface module having circuitry for performing robot arm dependent functions including circuit means for generating power amplifier control signals in response to input voltage command signals; said arm interface module circuitry further including circuit means for processing and manipulating position, velocity and motor current feedback signals; a torque processor module having torque microprocessor servo means for operating each of respective torque control loops for the respective joint motors; said torque microprocessor servo means generating said input voltage command signals in response to input torque commands and feedback motor current signals; a servo control module having position/velocity microprocessor servo means having digital signal processing capability for operating position and velocity control loops for the respective joint motors; said position/velocity microprocessor servo means generating said input torque commands in response to input position commands and said position and velocity feedback signals; said servo control module further including system resource means providing a hierarchical general support for the operation of said servo means providing enhancement in performance and functionality, and including data communicating control means for communications interfacing with local input/output devices and other systems and devices; program storage means for storing program means operative when executed to provide trajectory planning and interpolation and generate said input position commands in accordance with predefined moves set forth in a robot program; means for coupling said program storage means to said position/velocity microprocessor servo means to enable execution of said program means therein; and means for interconnecting said servo control, torque processor and arm interface modules to provide a complete basic control for said robot joint motors.
Claim 13
Dependent Claim
311 words
A module digital control for a robot having an arm with each of a plurality of joints driven by an electric motor in turn supplied with drive current by a power amplifier, said modular robot control being implemented by a hierarchical set of functionally integrated modules, comprising: an arm interface module having circuitry for performing robot arm dependent functions including circuit means for generating power amplifier control signals in response to input voltage command signals; said arm interface module circuitry further including circuit means for processing and manipulating position, velocity and motor current feedback signals; a torque processor module having torque microprocessor servo means for operating each of respective torque control loops for the respective joint motors; said torque microprocessor servo means generating said input voltage command signals in response to input torque commands and feedback motor current signals; a servo control module having position/velocity microprocessor servo means having digital signal processing capability for operating position and velocity control loops for the respective joint motors; said position/velocity microprocessor servo means generating said input torque commands in response to input position commands and said position and velocity feedback signals; said servo control module further including system resource means providing a hierarchical general support for the operation of said servo means providing enhancement in performance and functionality, and including data communicating control means for communications interfacing with local input/output devices and other systems and devices; program storage means for storing program means operative when executed to provide trajectory planning and interpolation and generate said input position commands in accordance with predefined moves set forth in a robot program; means for coupling said program storage means to said position/velocity microprocessor servo means to enable execution of said program means therein; and means for interconnecting said servo control, torque processor and arm interface modules to provide a complete basic control for said robot joint motors.
References Cited (Backward Citations)
US4240016A
Cited
US4538233A
Cited
US4633414A
Cited
US4594670A
Cited
US4578764A
Cited
US4631689A
Cited
US4625285A
Cited
US4623971A
Cited
US4654569A
Cited
US4613269A
Cited
US4665352A
Cited
US4718078A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1993-03-12 | 1993-09-11 | 1994-03-13 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1997-03-12 | 1997-09-11 | 1998-03-13 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2001-03-12 | 2001-09-11 | 2002-03-13 | $7700.00 | Window Closed / Lapsed |