Patent US5441510A successfully refreshed from Google Patents.
US4864206A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Multiaxis robot control having improved energy monitoring system for protecting robots against joint motor overload
Assignee: Staeubli International AG
•
Filing: 1988-04-06
•
Granted: 1989-09-05
•
Expires: 2008-04-06
Abstract
Abstract A digital robot control includes a position/velocity microprocessor control and a torque microprocessor control for each of multiple robot axes. Digital position, velocity and motor current feedback signals are generated from motor sensor signals for use in making microprocessor control calculations. Another motor sensor generates an overlimit signal when motor temperature rises above a limit value to indicate excessive motor current. The torque microprocessor makes a backup motor energy calculation from the feedback motor current signal from each joint motor and compares the result to a stored motor energy limit. The robot is shut down if either limit is exceeded.
Inventors
- 👤 Eimei M. Onaga
- 👤 Richard J. Casler, Jr.
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-24 08:03
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/406; G05B19/4062; G05B2219/00; G05B2219/30; G05B2219/33; G05B2219/33337; G05B2219/37; G05B2219/37312; G05B2219/37313; G05B2219/42; G05B2219/42256; G05B2219/42289; G05B2219/42318; G05B2219/45; G05B2219/45083
Claims Analysis
Total Claims: 12
Claim 1
Independent Claim
230 words
A digital control for a robot having a plurality of arm joints, said control comprising: an electric motor constituting a joint motor for driving each of the robot arm joints; a power amplifier operable to supply drive current to each joint motor; each joint motor having digital feedback control loop means operable at a predetermined sampling rate and including digital position and velocity control loops driving a digital torque control loop in accordance with digital position commands to generate digital motor voltage commands for controlling the associated power amplifier; means for sensing the motion of the each joint motor and for generating corresponding digital position and velocity feedback signals for control calculations in said position and velocity control loops; means for generating digital signals representative of the respective joint motor drive currents for control calculations in said torque control loop; means for sensing motor temperature and for generating an overtemperature signal when a predetermined motor temperature is exceeded indicating excessive motor current flow; energy monitoring and evaluating means independently determining the energy applied to each joint motor from the historical digital representation of motor current; means for comparing the calculated energy for each joint motor to a predetermined energy limit for that motor and for generating an overlimit signal when that limit is exceeded; and means for shutting down robot motor energization when said overtemperature or overlimit signal is generated.
Claim 2
Dependent Claim
230 words
A digital control for a robot having a plurality of arm joints, said control comprising: an electric motor constituting a joint motor for driving each of the robot arm joints; a power amplifier operable to supply drive current to each joint motor; each joint motor having digital feedback control loop means operable at a predetermined sampling rate and including digital position and velocity control loops driving a digital torque control loop in accordance with digital position commands to generate digital motor voltage commands for controlling the associated power amplifier; means for sensing the motion of the each joint motor and for generating corresponding digital position and velocity feedback signals for control calculations in said position and velocity control loops; means for generating digital signals representative of the respective joint motor drive currents for control calculations in said torque control loop; means for sensing motor temperature and for generating an overtemperature signal when a predetermined motor temperature is exceeded indicating excessive motor current flow; energy monitoring and evaluating means independently determining the energy applied to each joint motor from the historical digital representation of motor current; means for comparing the calculated energy for each joint motor to a predetermined energy limit for that motor and for generating an overlimit signal when that limit is exceeded; and means for shutting down robot motor energization when said overtemperature or overlimit signal is generated.
Claim 3
Dependent Claim
21 words
A digital robot control as sets forth in claim 1 wherein the motor torque energy limit is based on motor capability.
Claim 4
Dependent Claim
31 words
A digital robot control as set forth in claim 1 wherein the motor torque energy limit is less than the motor capability limit and is based on a predetermined use condition.
Claim 5
Dependent Claim
24 words
A digital robot control as set forth in claim 3 wherein the predetermined use condition is based upon operating limitations specified for motor operation.
Claim 6
Dependent Claim
60 words
A digital robot control as set forth in claim 1 wherein said energy monitoring and evaluating means generates a scalar proportional to the electrical power from the squared value of each current feedback sample, averages the power scalar values over a predetermined time period, and filters the averaged scalar to generate as an output said calculated energy for each motor.
Claim 7
Dependent Claim
48 words
A digital robot control as set forth in claim 1 wherein the following algorithm is employed in the energy calculation: ______________________________________
Algorithm:
______________________________________
temp = CURl**2 - ENERGY
ZOENGY = ZOENGY + temp
ENERGY = ZOENGY / 2**16 *TAU
if |ENERGY| > ELIMIT
then ECODE = OVENGY.
______________________________________
Claim 8
Dependent Claim
87 words
A digital robot control as set forth in claim 1 wherein each of said motor torque control loops includes torque servo control means having microprocessor means for generating motor voltage commands from torque commands and motor current feedback signals; another servo control means having another microprocessor means included in each of said motor velocity control loops and generating torque commands in response to position and velocity commands and position and velocity feedback signals; and said torque microprocessor means including said energy monitoring means and said comparing means.
Claim 9
Dependent Claim
215 words
A robot comprising: an arm having a plurality of joints; an electric motor for driving each of the robot arm joints; a power amplifier operable to supply drive current to each motor; each motor having digital feedback control loop means operable at a predetermined sampling rate and including digital position and velocity control loops driving a digital torque control loop in accordance with digital position commands to generate digital motor voltage commands for controlling the associated power amplifier; means for sensing the motion of each motor and for generating corresponding digital position and velocity feedback signals for control calculations in said position and velocity control loops; means for generating digital signals representative of the respective motor drive currents for control calculations in said torque control loop; means for sensing motor temperature and for generating an overtemperature signal when a predetermined motor temperature is exceeded indicating excessive motor current flow; energy monitoring means, determining independently of the sampling rate, the energy applied to each motor from the digital representation of motor current; means for comparing the calculated energy for each motor to a predetermined energy limit for that motor and for generating an overlimit signal when that limit is exceeded; and means for shutting down robot motor energization when said overtemperature or overlimit signal is generated.
Claim 10
Dependent Claim
215 words
A robot comprising: an arm having a plurality of joints; an electric motor for driving each of the robot arm joints; a power amplifier operable to supply drive current to each motor; each motor having digital feedback control loop means operable at a predetermined sampling rate and including digital position and velocity control loops driving a digital torque control loop in accordance with digital position commands to generate digital motor voltage commands for controlling the associated power amplifier; means for sensing the motion of each motor and for generating corresponding digital position and velocity feedback signals for control calculations in said position and velocity control loops; means for generating digital signals representative of the respective motor drive currents for control calculations in said torque control loop; means for sensing motor temperature and for generating an overtemperature signal when a predetermined motor temperature is exceeded indicating excessive motor current flow; energy monitoring means, determining independently of the sampling rate, the energy applied to each motor from the digital representation of motor current; means for comparing the calculated energy for each motor to a predetermined energy limit for that motor and for generating an overlimit signal when that limit is exceeded; and means for shutting down robot motor energization when said overtemperature or overlimit signal is generated.
Claim 11
Dependent Claim
56 words
A robot as set forth in claim 8 wherein said energy monitoring means generates a scalar proportional to the electrical power from the squared value of each current feedback sample, averages the power scalar values over a predetermined time period, and filters the averaged scalar to generate as an output said calculated energy for each motor.
Claim 12
Dependent Claim
85 words
A robot as set forth in claim 8 wherein each of said motor torque control loops includes torque servo control means having microprocessor means for generating motor voltage commands from torque commands and motor current feedback signals; another servo control means having another microprocessor means included in each of said motor velocity control loops and generating torque commands in response to position and velocity commands and position and velocity feedback signals; and said torque microprocessor means including said energy monitoring means and said comparing means.
References Cited (Backward Citations)
US3646396A
Cited
US4473856A
Cited
US4475160A
Cited
US4587469A
Cited
US4524313A
Cited
US4523135A
Cited
US4529921A
Cited
US4467260A
Cited
US4611682A
Cited
US4604561A
Cited
US4682089A
Cited
US4661032A
Cited
US4718078A
Cited
US4714865A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1992-09-04 | 1993-03-06 | 1993-09-05 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1996-09-04 | 1997-03-06 | 1997-09-05 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2000-09-04 | 2001-03-06 | 2001-09-05 | $7700.00 | Window Closed / Lapsed |