US4773025A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Multiaxis robot control having curve fitted path control
Assignee: Staeubli International AG
•
Filing: 1986-11-20
•
Granted: 1988-09-20
•
Expires: 2006-11-20
Abstract
Abstract A digital control is provided for a robot having a plurality of arm joints. The control includes an electric motor for driving each of the robot arm joints and a power amplifier supplies drive current to each motor. Each joint motor has feedback control loop means including at least digital position, velocity and torque control loops operable at a predetermined sampling rate to control the associated power amplifier. Digital motor position, velocity and drive current feedback signals are generated for the control loop means for all of the robot axes. Paired system microprocessors or paired position/velocity microprocessors generate position commands for the feedback control loop means in accordance with predefined moves set forth in a robot program. A planning program generates a time profile including acceleration, slew and deceleration time segments for each commanded robot program move. A trajectory program generates position commands for each of the feedback control loop means in accordance with a curved path trajectory and in accordance with the time profile applicable to the current move segment. The trajectory program employs stored third order polynomial equations and arc equations each having predetermined variable parameters operative to particularize that equation to a commanded curved path segment. The trajectory program responds to parameters specified by the robot program and implements the stored equations corresponding to the specified parameters to generate the position commands and define a tool tip trajectory corresponding to the curved path defined by the robot program.
Inventors
- 👤 Rajan C. Penkar
- 👤 Timothy P. Skewis
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-27 09:09
CPC Classifications
G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/416; G05B2219/00; G05B2219/30; G05B2219/33; G05B2219/33337; G05B2219/34; G05B2219/34135; G05B2219/34142; G05B2219/42; G05B2219/42256
Claims Analysis
Total Claims: 19
Claim 1
Independent Claim
260 words
A digital control for a robot having a plurality of arm joints, said control comprising: an electric motor for driving each of the robot arm joints; a power amplifier operable to supply drive current to each motor; feedback control loop means for each joint motor including at least digital position, velocity and torque control looops operable at a predetermined sampling rate to control the associated power amplifier; means for generating digital motor position, velocity and drive current feedback signals for said control loop means for all of the robot axes; digital control means for generating position commands for said feedback control loop means in accordance with predefined moves set forth in a robot program; said position command generating means including planning program means having means for generating a time profile including acceleration, slew and deceleration time segments for each commanded robot program move; said position command generating means further including trajectory program means for generating position commands for each of said feedback control loop means in accordance with a curved path trajectory and in accordance with the time profile applicable to the current move segment; said trajectory program generating means including stored curve defining equations each having predetermined variable parameters operative to particularize that equation to a commanded curved path segment; said trajectory program generating means further having means for responding to parameters specified by the robot program and for implementing the stored equations corresponding to the specified parameters to generate said position commands and define a tool tip trajectory corresponding to the curved path defined by the robot program.
Claim 2
Dependent Claim
260 words
A digital control for a robot having a plurality of arm joints, said control comprising: an electric motor for driving each of the robot arm joints; a power amplifier operable to supply drive current to each motor; feedback control loop means for each joint motor including at least digital position, velocity and torque control looops operable at a predetermined sampling rate to control the associated power amplifier; means for generating digital motor position, velocity and drive current feedback signals for said control loop means for all of the robot axes; digital control means for generating position commands for said feedback control loop means in accordance with predefined moves set forth in a robot program; said position command generating means including planning program means having means for generating a time profile including acceleration, slew and deceleration time segments for each commanded robot program move; said position command generating means further including trajectory program means for generating position commands for each of said feedback control loop means in accordance with a curved path trajectory and in accordance with the time profile applicable to the current move segment; said trajectory program generating means including stored curve defining equations each having predetermined variable parameters operative to particularize that equation to a commanded curved path segment; said trajectory program generating means further having means for responding to parameters specified by the robot program and for implementing the stored equations corresponding to the specified parameters to generate said position commands and define a tool tip trajectory corresponding to the curved path defined by the robot program.
Claim 3
Dependent Claim
40 words
A robot control as set forth in claim 1 wherein said equations include a polynomial equation having an order above one and the specified parameters include coefficients specified for the polynomial equation to fit it to the commanded curved path.
Claim 4
Dependent Claim
18 words
A robot control as set forth in claim 2 wherein said polynomial equation has an order above two.
Claim 5
Dependent Claim
18 words
A robot control as set forth in claim 2 wherein said polynomial equation has an order of three.
Claim 6
Dependent Claim
37 words
A robot control as set forth in claim 2 wherein said equations include an arc equation and the specified parameters include at least two points on the commanded arc path to fit the arc equation to it.
Claim 7
Dependent Claim
18 words
A robot control as set forth in claim 5 wherein said polynomial equation has an order above two.
Claim 8
Dependent Claim
38 words
A robot control as set forth in claim 2 wherein means are provided for responding to tool orientation commands from the robot program to control the tool orientation as the tool is moved through its curved path trajectory.
Claim 9
Dependent Claim
42 words
A robot control as set forth in claim 5 wherein a position/velocity microprocessor servo means is provided for operating the position/velocity control loops and for executing said planning and trajectory program means to generate said position commands for the position/velocity control loops.
Claim 10
Dependent Claim
75 words
A robot control as set forth in claim 8 wherein said microprocessor servo means includes calculating microprocessor means and a data processing microprocessor, and means for coupling said data processing microprocessor and said calculating microprocessor means so as to enable said data processing microprocessor to manage the flow of input/output data to and from said calculating microprocessor means during execution of said planning and trajectory program means and during execution of position/velocity control loop programming.
Claim 11
Dependent Claim
22 words
A robot control as set forth in claim 9 wherein torque microprocessor servo means is provided for operating the torque control loops.
Claim 12
Dependent Claim
29 words
A robot control as set forth in claim 5 wherein said planning and trajectory means includes continuous path program means for smoothing the command trajectory between curved path segments.
Claim 13
Dependent Claim
90 words
A robot control as set forth in claim 5 wherein a position/velocity microprocessor servo means is provided for operating the position and velocity control loops and system microprocessor means are provided for executing said planning and trajectory program means, said microprocessor servo means including a calculating microprocessor for executing position/velocity control calculations and further including a data processing microprocessor, and means for coupling said data processing microprocessor and said calculating microprocessor to enable said data processing microprocessor to manage the flow of input/output data to and from said calculating microprocessor.
Claim 14
Dependent Claim
252 words
A robot comprising: an arm having a plurality of joints; each of said joints having an electric motor drive; a power amplifier operable to supply drive current to each motor; feedback control loop means for each joint motor including at least digital position, velocity and torque control loops operable at a predetermined sampling rate to control the associated power amplifier; means for generating digital motor position, velocity and drive current feedback signals for said control loop means for all of the robot axes; digital control means for generating position commands for said feedback control loop means in accordance with predefined moves set forth in a robot program; said position command generating means including planning program means having means for generating a time profile including acceleration, slew and deceleration time segments for each commanded robot program move; said position command generating means further including trajectory program means for generating position commands for each of said feedback control loop means in accordance with a curved trajectory and in accordance with the time profile applicable to the current move segment; said trajectory program generating means including stored curve defining equations each having predetermined variable parameters operative to particularize that equation to a commanded curved path segment; said trajectory program generating means further having means for responding to parameters specified by the robot program and for implementing the stored equations corresponding to the specified parameters to generate said position commands and define a tool tip trajectory corresponding to the curved path defined by the robot program.
Claim 15
Dependent Claim
252 words
A robot comprising: an arm having a plurality of joints; each of said joints having an electric motor drive; a power amplifier operable to supply drive current to each motor; feedback control loop means for each joint motor including at least digital position, velocity and torque control loops operable at a predetermined sampling rate to control the associated power amplifier; means for generating digital motor position, velocity and drive current feedback signals for said control loop means for all of the robot axes; digital control means for generating position commands for said feedback control loop means in accordance with predefined moves set forth in a robot program; said position command generating means including planning program means having means for generating a time profile including acceleration, slew and deceleration time segments for each commanded robot program move; said position command generating means further including trajectory program means for generating position commands for each of said feedback control loop means in accordance with a curved trajectory and in accordance with the time profile applicable to the current move segment; said trajectory program generating means including stored curve defining equations each having predetermined variable parameters operative to particularize that equation to a commanded curved path segment; said trajectory program generating means further having means for responding to parameters specified by the robot program and for implementing the stored equations corresponding to the specified parameters to generate said position commands and define a tool tip trajectory corresponding to the curved path defined by the robot program.
Claim 16
Dependent Claim
39 words
A robot as set forth in claim 13 wherein said equations include a polynomial equation having an order above one and the specified parameters include coefficients specified for the polynomial equation to fit it to the commanded curved path.
Claim 17
Dependent Claim
36 words
A robot as set forth in claim 14 wherein said equations include an arc equation and the specified parameters include at least two points on the commanded arc path to fit the arc equation to it.
Claim 18
Dependent Claim
17 words
A robot as set forth in claim 15 wherein said polynomial equation has an order above two.
Claim 19
Dependent Claim
41 words
A robot as set forth in claim 15 wherein a position/velocity microprocessor servo means is provided for operating the position/velocity control loops and for executing said planning and trajectory program means to generate said position commands for the position/velocity control loops.
References Cited (Backward Citations)
US4362978A
Cited
US4506321A
Cited
US4535405A
Cited
US4623971A
Cited
US4603284A
Cited
US4598380A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1991-09-20 | 1992-03-21 | 1992-09-20 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 1995-09-20 | 1996-03-21 | 1996-09-20 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 1999-09-20 | 2000-03-21 | 2000-09-20 | $7700.00 | Window Closed / Lapsed |