Multiprocessor position/velocity servo control for multiaxis digital robot control system
First Claim
1. A digitally controlled robot comprising:
- an arm having a plurality of joints;
each of said joints being axis driven by an electric motor drive;
a power amplifier operable to supply drive current to each joint drive motor;
respective feedback control loop means for respectively controlling said power amplifier for each of said joint drive motors;
each of said feedback control loop means including an associated pair of digital position and velocity control loops operable to control the associated power amplifier;
servo control means for performing control support tasks and calculation tasks for each associated pair of said position and velocity control loops for all of the joint drive motors;
said position and velocity servo control means including a first microprocessor for performing calculation tasks including digitally computing output torque control commands from input position commands and feedback position and velocity and from stored algorithms for said associated pair of position and velocity control loops for each joint drive motor;
said first microprocessor having a relatively high computing performance capability and a relatively low data processing interface capability;
said position and velocity servo control means further including a second microprocessor for supervising the operation of said position and velocity servo control means and performing servo control support tasks in said associated pair of control loops for each joint drive motor;
said second microprocessor having a relatively high data processing performance capability;
means for interfacing said first and second microprocessors relative to each other and relative to higher and lower level control circuitry so as to enable said position and velocity servo control means to operate said associated control loops for each joint drive motor and provide position and velocity control for each joint drive motor;
said lower level control circuitry including respective torque control circuitry for generating motor voltage commands for coupling to said power amplifiers;
means for generating position commands for implementation by said second microprocessor;
means for detecting motor position and velocity for each drive axis and for generating corresponding digital feedback signals;
means for operating said second microprocessor to control said interfacing means so as to send position commands to said first microprocessor and receive calculated torque commands from said first microprocessor; and
means for operating said second microprocessor to apply the torque commands to said torque control circuitry for execution and for synchronously receiving from said motor detecting means the digital feedback position and velocity signals.
1 Assignment
0 Petitions
Accused Products
Abstract
A digital robot control is provided with position/velocity and torque control loops with microprocessor servo controllers in each. The position/velocity servo controller includes two microprocessors that operate as a servo engine in providing position/velocity control for six robot axes. One microprocessor operates as a manager to perform data processing and coordination tasks supportive to position/velocity control. The other microprocessor performs position and velocity servo calculation tasks and operates as a slave processor to the position/velocity control manager. The programming for the position/velocity control sends manager position and other commands and position and velocity feedback from other control levels to the position/velocity calculator and sends torque commands received from the calculator to the next lower control level. The calculator employs position/velocity control algorithms in making torque command calculations.
-
Citations
7 Claims
-
1. A digitally controlled robot comprising:
-
an arm having a plurality of joints; each of said joints being axis driven by an electric motor drive; a power amplifier operable to supply drive current to each joint drive motor; respective feedback control loop means for respectively controlling said power amplifier for each of said joint drive motors; each of said feedback control loop means including an associated pair of digital position and velocity control loops operable to control the associated power amplifier; servo control means for performing control support tasks and calculation tasks for each associated pair of said position and velocity control loops for all of the joint drive motors; said position and velocity servo control means including a first microprocessor for performing calculation tasks including digitally computing output torque control commands from input position commands and feedback position and velocity and from stored algorithms for said associated pair of position and velocity control loops for each joint drive motor; said first microprocessor having a relatively high computing performance capability and a relatively low data processing interface capability; said position and velocity servo control means further including a second microprocessor for supervising the operation of said position and velocity servo control means and performing servo control support tasks in said associated pair of control loops for each joint drive motor; said second microprocessor having a relatively high data processing performance capability; means for interfacing said first and second microprocessors relative to each other and relative to higher and lower level control circuitry so as to enable said position and velocity servo control means to operate said associated control loops for each joint drive motor and provide position and velocity control for each joint drive motor; said lower level control circuitry including respective torque control circuitry for generating motor voltage commands for coupling to said power amplifiers; means for generating position commands for implementation by said second microprocessor; means for detecting motor position and velocity for each drive axis and for generating corresponding digital feedback signals; means for operating said second microprocessor to control said interfacing means so as to send position commands to said first microprocessor and receive calculated torque commands from said first microprocessor; and means for operating said second microprocessor to apply the torque commands to said torque control circuitry for execution and for synchronously receiving from said motor detecting means the digital feedback position and velocity signals. - View Dependent Claims (2, 3)
-
-
4. A digital control for a robot having a plurality of arm joints each joint being driven about an axis by an electric motor, said control comprising:
-
a power amplifier operable to supply drive current to each joint motor; respective feedback control loop means for respectively controlling said power amplifier for each of said joint motors; each of said feedback control loop means including associated digital position and velocity control loops operable to control the associated power amplifier; servo control means for performing control support tasks and calculation tasks for said position and velocity control loops for all of the joint motors; said position and velocity servo control means including a first microprocessor for performing calculation tasks including digitally computing output torque control commands from input position commands and feedback position and velocity and from stored algorithms for said associated digital position and velocity control loops for each joint motor; said first microprocessor having a relatively high computing performance capability and a relatively low data processing interface capability; said position and velocity servo control means further including a second microprocessor for supervising the operation of said position and velocity servo control means and performing servo control support tasks in said associated digital control loops for each joint motor; means for interfacing said first and second microprocessors relative to higher and lower level control circuitry so as to enable said position and velocity servo control means to operate said associated digital control loops for each joint motor and provide position and velocity control for each joint motor; said lower level control circuitry including respective torque control circuitry for generating motor voltage commands for coupling to said power amplifiers; means for generating position commands for implementation by said second microprocessor; means for detecting motor position and velocity for each joint axis and for generating corresponding digital feedback signals; means for operating said second microprocessor to control said interfacing means so as to send position commands to said first microprocessor and receive calculated torque commands from said first microprocessor; and means for operating said second microprocessor to apply the torque commands to said torque control circuitry for execution and for synchronously receiving from said motor detecting and generating means the digital feedback signals. - View Dependent Claims (5, 6)
-
-
7. A digital servo control for a robot control system that employs respective feedback control loop means to control the energization about an axis of a respective arm joint motor, with each of the feedback control loop means including at least digital position and velocity and torque control loops;
- said servo control comprising;
a first microprocessor for performing calculation tasks including computing output torque control commands from input position commands and position and velocity feedback and from stored algorithms for at least said position and velocity control loops for all of the joint motors; said first microprocessor having a relatively high computing performance capability and a relatively low data processing interface capability; a second microprocessor for supervising the operation of said first microprocessor and performing servo control support tasks in said position and velocity control loops for each arm joint motor including the routing of control commands, and status and feedback data to and from said first microprocessor; means for interfacing said first and second microprocessors relative to each other and relative to higher and lower control circuitry so as to enable said first microprocessor to operate said position and velocity control loops for each arm joint motor; said lower level circuitry including respective torque control circuitry for generating motor voltage commands for coupling to said power amplifiers; means for generating position commands for implementation by said second microprocessor; means for detecting motor position and velocity for each arm joint axis and for generating corresponding digital feedback signals; means for operating said second microprocessor to control said interfacing means so as to send position commands to said first microprocessor and receive calculated torque commands from said first microprocessor; and means for operating said second microprocessor to apply the torque commands to said torque control circuitry for execution and to receive from said motor detecting means digital feedback position and velocity signals.
- said servo control comprising;
Specification