Robot control with improved safety

Patent metadata

Field	Value
Publication number	US-9914216-B2
Application number	US-201214441349-A
Country	US
Kind code	B2
Filing date	Nov 9, 2012
Priority date	Nov 9, 2012
Publication date	Mar 13, 2018
Grant date	Mar 13, 2018

Abstract

For controlling a robot in a safe way, a highest voltage required for a desired robot movement is calculated. A voltage level in a DC-bus is set on the basis of the highest voltage, and current is supplied to a motor at a robot axis from the DC-bus. By limiting the voltage level in the DC-bus to correspond to an actual need for a desired robot movement at each instant unnecessary fast robot movements are prevented even in the event that an inverter controlling motor currents would by mistake attempt to drive the motor faster than desired by the operator.

First claim

The invention claimed is:

1. A method for controlling a robot with a robot drive unit, the method comprising the steps of:
setting with a mode selector unit a predetermined maximum voltage level;
calculating with the robot drive unit a highest voltage required for a robot movement;
setting with the robot drive unit a limit of a first voltage level in a DC-bus on the bases of the maximum voltage level and the highest voltage; and
supplying current to a motor at a robot axis from the DC-bus so that the motor can perform the robot movement.

2. The method according to claim 1 , the method further comprising the step of:
setting the first voltage level to be at most 50% higher than the calculated highest voltage.

3. The method according to claim 1 , the method further comprising the steps of:
providing more than one operation modes, each operation mode having a predetermined maximum voltage level in the DC-bus different from the maximum voltage levels of the remaining operation modes; and
setting the first voltage level to be equal with the maximum voltage level of the current operation mode if the calculated highest voltage exceeds the maximum voltage level of the current operation mode.

4. The method according to claim 3 , the method further comprising the steps of:
measuring a voltage from the DC-bus; and
actuating an emergency stop if the voltage exceeds the maximum voltage level of the current operation mode.

5. The method according to claim 3 , wherein the number of operation modes is three.

6. The method according to claim 3 , wherein one of the operation modes has a maximum voltage level that corresponds to a maximum voltage required for keeping an unloaded robot at standstill against gravity torque.

7. The method according to claim 1 , the method further comprising the step of:
setting the first voltage level at least once per second.

8. The method according to claim 1 , wherein the step of calculating is performed with a calculation unit and the step of setting is performed with a rectifier.

9. The method according to claim 1 , wherein a plurality of motors are supplied current by the DC-bus.

10. The method according to claim 1 , wherein a rectifier sets the limit in the DC-bus.

11. The method according to claim 1 , wherein the step of calculating is based at least in part on instructions used by an inverter to control the robot movement.

12. A robot drive unit comprising
a mode selector unit configured to set a predetermined maximum voltage level,
a DC-bus supplying current to a motor at a robot axis,
characterized in that the robot drive unit further comprises a calculation unit configured to calculate a highest voltage required for a robot movement, and a voltage source setting a limit of a first voltage level in the DC-bus on the bases of the maximum voltage level and the highest voltage, the current from the DC-bus supplied to the motor to perform the robot movement.

13. The robot drive unit according to claim 12 , wherein the robot drive unit has three operation modes, each operation mode having a predetermined maximum voltage level different from those of the remaining operation modes, and the robot drive unit further comprises the mode selector for selecting an operation mode.

14. The robot drive unit according to claim 13 , wherein the voltage source is configured to set the first voltage level to be equal with the maximum voltage level of the current operation mode if the calculated highest voltage exceeds the maximum voltage level of the current operation mode.

15. The robot drive unit according to claim 12 , wherein the robot drive unit further comprises a voltage sensor for measuring a voltage from the DC-bus, and a safety module which compares the measured voltage with the maximum voltage level of a current operation mode, the safety module being configured to actuate an emergency stop if the voltage exceeds the maximum voltage level of the current operation mode.

16. The robot drive unit according to claim 12 , wherein a plurality of motors are supplied current by the DC-bus.

17. The robot drive unit according to claim 12 , wherein the first voltage level is set at least once per second.

18. A robot drive unit comprising:
a DC-bus supplying current to a motor at a robot axis;
a voltage sensor measuring a voltage from the DC-bus;
the robot drive unit having three operation modes, each operation mode having a predetermined maximum voltage level different from those of the remaining operation modes;
a safety module comparing the measured voltage with the maximum voltage level of a current operation mode, and actuating an emergency stop if the voltage exceeds the maximum voltage level of the current operation mode;
a calculation unit calculating a highest voltage required for a robot movement, and setting a limit of a first voltage level in the DC-bus on the basis of the highest voltage, the current from the DC-bus supplied to the motor to perform the robot movement.

Assignees

• Abb Schweiz Ag

Inventors

• Jonsson Ingvar

Classifications

• G05B2219/36472

  During teaching low servo power, during playback high servo power · CPC title

• B25J9/1656 Primary

  characterised by programming, planning systems for manipulators · CPC title

• B25J9/1674 Primary

  characterised by safety, monitoring, diagnostic · CPC title