Multiaxis robot control having curve fitted path control
US4773025A · kind A · utility
Assignee
Inventors
Key dates
| Filing date | Nov 20, 1986 |
| Grant date | Sep 20, 1988 |
| Priority date | — |
| Expiry date | Nov 20, 2006 |
Classification
- Technology area (CPC G)Physics
- CPC primaryG05B2219/42256
- WIPO fieldControl
- WIPO sectorInstruments
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 e…
Source: USPTO / EPO open patent data. Objective bibliographic and citation counts.