METHOD FOR CONTROLLING AN AUTOMATED WORK CELL

• US 20130116821A1
• Filed: 05/13/2011
• Published: 05/09/2013
• Est. Priority Date: 05/14/2010
• Status: Active Grant

• Current Assignee: Staubli Faverges (Stã¤Ubli Holding AG)
• Original Assignee: Staubli Faverges (Stã¤Ubli Holding AG)
• Inventors: Joly, Luc, Bonnet Des Tuves, Jean Michel, Pertin, Franois, Vogt, Grald
• Granted Patent: US 8,965,574 B2
• Time in Patent Office: Days
• US Class Current: 700/254
• CPC Class Codes: B25J 9/16 Programme controls programme controls in general G05B19/00, e.g. numerical pogramme controls G05B19/18; recording or playback systems G05B19/42
• CPC Class Codes: B25J 9/161 Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
• CPC Class Codes: G05B 19/4086 Coordinate conversions; Other special calculations
• CPC Class Codes: G05B 2219/33273 DCS distributed, decentralised controlsystem, multiprocessor
• CPC Class Codes: G05B 2219/39253 Virtual arm, has end effector on any joint of real manipulator
• CPC Class Codes: G05B 2219/39384 Control unit near robot, control and teaching panel in safe zone
• CPC Class Codes: G05B 2219/39408 Integrated structure and control design

Abstract

The invention relates to a control method applied to an automated work cell which includes at least one robot arm (4) having at least three degrees of freedom controlled according to a plurality of control axes (A1-A6; X, Y, Z, Rx, Ry, Rz); a control centre (8); a device (6) for controlling the robot arm (4), which includes a plurality of motor controllers (61-66) each controlling the operation of one motor (M1-M6), suitable for operating at least one portion of the robot arm (4); and a communication bus (14) between the control centre (8) and the device (6) for controlling the robot arm (4). Said method includes steps that consist of: a) sending instructions (Cri) emitted by the control centre (8) to control the control axes to a single arithmetic unit (10) belonging to the device (6) for controlling the robot (4); b) determining, within the arithmetic unit (10) and according to instructions received from the control centre (8), orders (0̂) for each one of the motors controlled by a motor controller; c) sending each motor controller an order, determined in step b), for the motor controlled by said motor controller.

Claims

1-13. -13. (canceled)

14. A method of controlling an automated work cell including

at least one robot arm with at least three degrees of freedom controlled according to several control axes,

a control center,

a device controlling the robot arm, including several motor controllers each controlling the functioning of a motor able to maneuver at least a part of the robot arm,

a bus for communication between the control center and the control device of the robot arm,

wherein the method comprises the steps of:

a) transmitting instructions, sent by the control center for controlling the control axes, to a single computing unit belonging to the device controlling the robot arm;

b) determining, in the computing unit and from several of the instructions received from the control center, instructions for each of the motors controlled by a motor controller;

c) transmitting to each motor controller an order, determined at step b), for the motor controlled by this motor controller.

15. The control method according to claim 14, including the supplementary steps of:

d) transmitting, from each motor controller and to the computing unit, the position of the motor that it controls;

e) calculating, in the computing unit and on the basis of all the positions of the motors, the positions of each of the control axes of the robot arm;

f) transmitting to the control center the positions calculated at step e).

16. The control method according to claim 15, including the supplementary steps of:

g) calculating, in the computing unit and on the basis of all the positions of the motors, the cartesian speed of a characteristic point;

h) comparing the calculated cartesian speed with a threshold value;

i) transmitting, from the computing unit and to the control centre, an alert signal if the cartesian speed is greater than the threshold value.

17. The control method according to claim 16, wherein the computing unit takes account, in the calculation of step e), the times of measuring the positions of the motors and the time of transmission to the control center of the positions of each of the control axes of the robot arm in order to correct the positions of the movement control axes according to the presumed movement of the robot arm.

18. The control method according to claim 14, wherein, at step b), movement orders including the positions to be reached for each motor for complying with the instructions sent by the control centre are calculated.

19. Control method according to claim 18, wherein, at step b), the calculation of the movement orders for each motor is accompanied by a prediction of the torque to be supplied for each motor, based on the instructions sent by the control center.

20. The control method according to claim 19, wherein the instructions sent by the control center contain information on the load transported for at least one movement control axis.

21. The control method according to claim 19, wherein the positions to be reached for each motor in order to comply with the instructions sent by the control center include a compensation for the deformations of the robot arm calculated from at least some of the torque predictions.

22. The control method according to claim 14, including a step consisting in:

d) transmitting to the control center a signal representing the state of powering up of the robot arm, in which the robot arm is respectively declared to be ready to function or powered down only if all the motors are powered up or powered down and braked.

23. The control method according to claim 14, including:

d) transmitting, from the computing unit and to the control centre, a signal representing the state of functioning of all the parts of the robot arm, in which all the parts of the robot arm are declared to be faulty if at least one of these parts is detected as not functioning.

24. The control method according to claim 14, wherein the bus supports a synchronous communication mode.

25. The control method according to claim 14, wherein the bus functions on an interface model of the SERCOS type.

26. The control method according to claim 25, wherein the control center communicates with the computing unit using the commands of a “

profile drive”

hardware profile.