DE202017103611U1 - Device for safety control of a machine - Google Patents

Abstract

Device for safety control of a machine (2), with at least one safe object sensor (3) for detecting objects (4) and simultaneous monitoring of several segments (5) of a surface (6), a safe control and evaluation unit (7) for evaluating the Signals of the at least one object sensor (3) and for generating control signals for the machine (2), characterized in that the control and evaluation unit (7) is adapted to calculate a trajectory (13) for the machine (2) and the calculated trajectory (13), which avoids segments (5) in which objects (4) are detected and selects segments (5) in which no objects (4) are detected.

Description

The present invention relates to a device for safety control of a machine, with at least one safe object sensor for the detection of objects and simultaneous monitoring of several segments of a surface, a safe control and evaluation unit for evaluating the signals of the at least one object sensor and for generating control signals for the machine ,

Such devices are from the EP 2 428 862 B1 and the DE 10 2005 049 159 A1 known.

A security of hazardous areas is carried out according to the prior art, for example, a long-term shut off the danger area, z. B. with fences. Thus, an interaction between machine and human is no longer possible. Is z. B. for troubleshooting a entering the area necessary, the machine is completely switched off.

Furthermore, a safeguard with a sensor is known which monitors an area in front of or around the machine, for example with a laser scanner. If an object, possibly a human, is detected in the area monitored by this sensor, the movement of the machine is stopped. The problem here is to choose the smallest possible protective field to achieve adequate productivity, depending on the specific situation.

The prior art is therefore to switch depending on the direction of movement and movement speed between different protective fields. This happens, for example, in a driverless transport vehicle depending on the steering angle and the speed traveled, taking into account the stopping distance. For a robot depending on the specific robot position. A configuration of the various protective fields is disadvantageously very complicated with increasing number of the same, as well as the validation of the safety function. Furthermore, a detected obstacle in any case leads to the stop of the machine and thus to an undesirable interruption in operation.

It is therefore an object of the invention to provide a controller for a machine which is to be dependent on a position of an object or human. The control should be safe, simple and manageable, so that a validation of the control is possible.

The object is achieved according to claim 1 by a device for safety control of a machine, with at least one safe object sensor for the detection of objects and simultaneous monitoring of several segments of a surface, a safe control and evaluation unit for evaluating the signals of the at least one object sensor and for generating Control signals for the machine, wherein the control and evaluation unit is adapted to calculate a trajectory for the machine and to select the calculated trajectory, which avoids segments in which objects are detected and selects segments in which no objects are detected.

The invention thus consists of a sensor which monitors an area. The area is divided into a plurality of smaller segments. A detection of an object in a segment generates a segment-specific signal. For each segment, at least one signal is generated to indicate whether or not an object has been detected. In this case, an immediate detection of the object in the segment is detected and also a potential detection in the segment, for example by shading of light beams in the vicinity of the sensor or by objects in adjacent segments, so that, for example, a single object is detected in two adjacent segments ,

The higher-order control and evaluation unit of the sensor thus receives information per segment as to whether this segment is definitely empty, that is to say safe, or whether there is potentially an object, for example a human being, and thus not secure.

Based on this information about the segments, the control and evaluation unit is designed to determine a trajectory, ie a path, trajectory or path that leads through the segments that are free, that is not occupied. This does not endanger the objects in the segments with the detected objects.

The safe control and evaluation unit knows the position of the machine within the segments, or the trajectory, for example, from a model formed from continuous safe measured values of the drives.

By dividing the total area to be monitored into segments, on the one hand, a very flexible, but on the other hand a still clear functionality arises, so that the sequences in the higher-level control and evaluation can be clearly programmed and the validation in the application is simplified.

The control and evaluation unit is integrated, for example, with the safe object sensor in a common housing.

Safety according to the present invention is safety in the sense of machine safety. For example, the standard EN / IEC 61496 regulates the requirements for a safe sensor or a safe non-contact protective device (ESPE) for the protection of hazardous areas. Machine safety is regulated in the standard EN13849. The security is ensured, for example, by a two-channel redundant or two-channel diverse construction of a control and evaluation unit for fault detection and functional testing. The safe object sensor or distance sensor according to the present invention, for example, intrinsically safe and detects internal errors. When an error is detected, for example, an error signal is generated. Furthermore, the safe object sensor optionally has a sensor test.

In a further development of the invention, a speed of the machine and a distance of the machine to a segment in which an object is detected are adapted such that a hazard to the object is excluded, wherein the speed is a safe speed and the distance is a safe distance ,

In this way, if the object is a person, irritation is avoided since, for example, the machine reduces the speed on the way in the direction of the person and performs an evasive movement in front of the person. If an interaction between the object, for example the human or a material object and the machine, an interaction is desired or intended, for. As for the insertion of a workpiece, the machine stops as close as possible and in a suitable position on the occupied segment.

In a further development of the invention, the safe control and evaluation unit is a safe safety control. This can be an external safety controller, which is connected via a line to the safe object sensor. The safety controller is a safety controller in accordance with the Machinery Directive, for example according to Category 4 (EN ISO 13849), Safety Integrity Level SIL3 (IEC 61508) or SILCL3 (EN62061).

This forms a modular system of safety control and at least one safe object sensor. The safety control can be individually selected depending on the functional requirement or the security level.

In a further development of the invention, the safe control and evaluation unit and the safe object sensor are connected via a fieldbus with security protocol. Via the fieldbus, a large number of data can be transmitted virtually simultaneously. In this case, the secure information about each segment, whether it is busy or free, can be transmitted to the safety controller. The fieldbus with safety protocol can be known open field buses or can also be special company solutions.

In a further development of the invention, the segments are square, rectangular, trapezoidal and / or triangular adjustable. Segments with these shapes are easy to string together to form a virtually any larger area of modularity. Optionally, the segments also have the same size. However, it is expressly provided according to the invention to use segments of different sizes. Depending on the size of the segments, any surface can be finely covered without, however, unnecessarily increasing the number of segments. If, for example, a rectangular area is to be monitored, simply square or rectangular segments can be used. With the help of trapezoidal or triangular segments, even pointed shapes can be covered. For example, depending on the desired application, fan-shaped surfaces can be formed with triangular or trapezoidal segments. Depending on the desired surface, segments with different surfaces can also be combined. The segments are preferably in a common plane.

In a further development of the invention, the segments have the same shapes. As a result, the evaluation is further simplified and for the user, the application is further simplified, since all surfaces are formed only with similar segment areas.

According to a preferred embodiment, the object sensor is a laser scanner. A laser scanner emits a light beam whose light transit time is evaluated in order to detect a distance to an object. The light beam is thereby preferably deflected in different directions via a light deflection unit in order to cover a monitoring area. The light deflection unit is, for example, a rotating mirror.

However, the laser scanner can also be a laser scanner with a multiplicity of transmitting and receiving pairs, which are statically fixed and with which a flat area is monitored.

Furthermore, according to the invention, a camera may also be provided as a safe object sensor, in particular a time-of-flight camera, which also makes it possible to evaluate the light transit time of received light and to calculate a plurality of distance points therefrom.

As a time-of-flight sensor element, at least one so-called single-photon avalanche diode, which is also known by the name "single photon avalanche photodiode" or SPAD, can be used for the camera as well as for the laser scanner. Other common names are Silicon Photomultiplier '(SiPM),' Geigermode Avalanche Photon Diode 'or' Single Photon Counting Diode '. Single-photon avalanche diodes are standard photosensitive detectors using standard CMOS technology, which, like avalanche photodiodes, convert incident photons into current pulses. However, unlike avalanche photodiodes, single photon avalanche diodes operate over a breakdown voltage. Thus, even a single incident photon triggers an avalanche effect, which can be detected as a current pulse. Due to the high sensitivity, namely an amplification factor of 10 ⁶ , even the lowest reception power can be detected down to single photons.

Use of a light transit time sensor, in particular the use of single photon avalanche diodes in combination with pulsed lasers, provides distance information with an accuracy of, for example, up to about one millimeter. At the same time, a simple optical attachment via focusing allows the realization of good spatial selectivity and differentiation from stray light.

For distance measurement, different light transit time methods can be implemented with a corresponding evaluation.

It may be provided a pulse method. For example, one or more time-to-digital converters are provided for the pulse method in which each single-photon event is time-stamped. For a useful signal, therefore, multiple timestamps occur correlated. The measured value is generated statistically. Background light, however, generates randomly distributed timestamps.

Furthermore, a CW method (continuous wave) or the synonymous continuous wave method can be used, wherein a continuous light signal is used throughout. In this method, the single-photon events are distributed in two counters via a gating signal, and a phase is calculated from the ratio of the counter readings.

Furthermore, analog signals of a single photon diode array can be evaluated. These are compared with a threshold, sampled or evaluated using statistical methods.

In the evaluation according to the time of flight method, an amplitude value can be generated in addition to the distance value, for. B. by a histogram of the time stamp, by a count rate or by a voltage amplitude in an analog evaluation. The amplitude value can be used to carry out a plausibility check, in particular in safety-related applications.

In a development of the invention, at least two object sensors, in particular two laser scanners, are provided which each detect identical segments from different directions. This captures objects from different directions and avoids annoying shadowing, allowing more segments to be classified as free. The measured values of the sensors are combined or calculated, for example, in a common coordinate field. The different object sensors capture an identical area and identical segments. The respective segment information is logically OR'ed. Ie. a segment is judged to be free if at least one of the sensors reports this segment as free. As a result, resulting occlusions are also mastered.

In development of the invention, the machine is a robot. For example, a robot of the type provided herein has a multi-limbed arm with a tool to perform, for example, handling operations or to perform certain movements that are always repeated in the same manner. These handling tasks can take place in interaction with other robots, machines or even human persons. It is provided according to the invention to monitor the motion field of the robot with the at least one object sensor, and to divide the motion field into individual segments.

In a preferred alternative embodiment, the engine is a vehicle. This may be, for example, an autonomous driverless vehicle, in particular a driverless small vehicle, for example, transporting material between processing stations. In this case, an object sensor is arranged on at least one side or at least one corner of the vehicle in order to monitor a plane parallel to the road or inclined surface. This area is divided according to the invention into segments which are monitored. If individual segments are occupied by objects, the vehicle drives around them. The control and evaluation unit takes over the task of selecting a trajectory or path for the vehicle, which avoids the occupied segments, ie drives around the obstacles or objects or people. The speed is the distance between the vehicle and z. B. human being adapted so that a threat is further excluded, as well as an irritation of the People is avoided. Only if either no corresponding trajectory is available or the interaction with a human is intended, for. B. for the loading of material, as close to the segment and thus stops on people. For the calculation of the trajectory, the control and evaluation unit is aware of its own relative position, or the control and evaluation unit continuously receives measured values from the drives in order to continuously create a position model.

In a further development of the invention, the control signals for the vehicle steering or braking signals.

• 1 eine Vorrichtung zur Sicherheitssteuerung einer Maschine mit wenigstens einem sicheren Objektsensor;
• 2 und 3 jeweils ein Fahrzeug mit einem Laserscanner.

The invention will be explained below with regard to further advantages and features with reference to the accompanying drawings with reference to embodiments. The figures of the drawing show in:

• 1 a device for safety control of a machine with at least one safe object sensor;
• 2 and 3 one vehicle each with a laser scanner.

In the following figures, identical parts are provided with identical reference numerals.

1 shows a device 1 for the safety control of a machine 2 with at least one safe object sensor 3 for the detection of objects 4 and simultaneous monitoring of multiple segments 5 a surface 6 , a secure control and evaluation unit 7 for evaluating the signals of the at least one object sensor 3 and for generating control signals for the machine 2 , wherein the control and evaluation unit 7 is formed, a trajectory 13 for the machine 2 to calculate and the calculated trajectory 13 to select which segments 5 avoids, in which objects 4 are detected and segments 4 chooses, in which no objects 4 are detected.

The area 6 is in a plurality of smaller segments 5 divided up. A detection of an object 4 in a segment 5 generates a segment-specific signal. For every segment 5 At least one separate signal is generated to indicate if an object 4 was detected or not. This is an immediate detection of the object 4 in the segment 5 detected and also a potential detection in the segment 5 for example, by a shadowing of light rays in the vicinity of the sensor 3 or by objects 4 in neighboring segments 5 so that, for example, a single object 4 in two adjacent segments 5 is detected.

The sensor 3 higher-level control and evaluation unit 7 So receives per segment 5 the information, if this segment 5 definitely empty, so safe or potentially an object in it 4 For example, a human is located and therefore not sure.

Based on this information about the segments 5 is the control and evaluation unit 7 trained, a trajectory 13 that is, to find a path, trajectory, or path through the segments 5 leads, which are free, so not occupied. This does not endanger the objects 4 in the segments 5 with the detected objects 4 ,

The safe control and evaluation unit 7 knows the position of the machine 2 within the segments 5 , or the trajectory 13 For example, from a model formed from continuous safe measurements of the drives of the machine.

The control and evaluation unit 7 is according to 1 with the safe object sensor 3 integrated in a common housing.

According to 2 are the safe control and evaluation unit 7 and the safe object sensor 3 over a fieldbus 14 connected to security protocol. About the fieldbus 14 a multitude of data can be transmitted virtually simultaneously. This can be the secure information for each segment 5 whether it is occupied or free, to the safety controller 8th be transmitted.

According to 1 and 2 are the segments 5 rectangular shaped.

According to 3 are the segments 5 trapezoidal and triangular.

According to the figures, the segments are 5 strung together to a nearly arbitrary larger area 6 modular form. According to 2 assign the segments 5 also the same size. According to 1 and 3 are segments 5 different size provided. According to 1 and 2 assign the segments 5 same forms.

According to 2 and 3 is the object sensor 3 a laser scanner 10 , A laser scanner 10 sends a beam of light whose light-time is evaluated to a distance to an object 4 capture. The light beam is thereby preferably deflected in different directions via a light deflection unit in order to cover a monitoring area. The light deflection unit is, for example, a rotating mirror.

According to the 1 to 3 is the machine 2 a vehicle 11 , in particular an autonomous driverless vehicle 11 which, for example, transports material between processing stations. In this case, an object sensor is on one side 3 arranged to be parallel to the road or inclined surface 6 to monitor. This area 6 is in segments according to the figures 5 divided, which are monitored. Are individual segments 5 through objects 4 occupied, the vehicle drives around 11 these. The control and evaluation unit 7 takes on the task, a trajectory 13 or track for the vehicle 11 to choose the occupied segments 5 avoids, ie the obstacles or objects 4 or people drive around. Here is the speed of the vehicle, the distance between the vehicle 11 and Z. B. man adapted so that a risk remains excluded, and an irritation of humans is avoided. Only if either no corresponding trajectory 13 is available or the interaction with a human intended, z. As for the loading of material, the vehicle stops as close to the segment and thus to the people. For the calculation of the trajectory 13 are the control and evaluation unit 7 the own relative position known, or receives the control and evaluation 7 continuous measurements from the drives to continuously create a position model.

LIST OF REFERENCE NUMBERS

1

contraption

2

machine

3

object sensor

4

object

5

segments

6

area

7

Control and evaluation unit

8th

safety control

9

fieldbus

10

laser scanner

11

vehicle

12

driverless vehicle

13

trajectory

14

fieldbus

QUOTES INCLUDE IN THE DESCRIPTION

This list of the documents listed by the applicant has been generated automatically and is included solely for the better information of the reader. The list is not part of the German patent or utility model application. The DPMA assumes no liability for any errors or omissions.

Cited patent literature

• EP 2428862 B1 [0002]
• DE 102005049159 A1 [0002]

Claims (12)

Device for safety control of a machine (2), with at least one safe object sensor (3) for detecting objects (4) and simultaneous monitoring of several segments (5) of a surface (6), a safe control and evaluation unit (7) for evaluating the Signals of the at least one object sensor (3) and for generating control signals for the machine (2), characterized in that the control and evaluation unit (7) is adapted to calculate a trajectory (13) for the machine (2) and the calculated trajectory (13), which avoids segments (5) in which objects (4) are detected and selects segments (5) in which no objects (4) are detected. Device according to at least one of the preceding claims, characterized in that a speed of the machine (2) and a distance of the machine (2) to a segment (5), in which an object (4) is detected, adapted such that a Hazard of the object (4) is excluded, the speed is a safe speed and the distance is a safe distance. Device according to at least one of the preceding claims, characterized in that the safe control and evaluation unit (7) is a safe safety control (8). Device according to at least one of the preceding claims, characterized in that the safe control and evaluation unit (7) and the safe object sensor (3) via a field bus (9) are connected to security protocol. Device according to at least one of the preceding claims, characterized in that the segments (5) are square, rectangular, trapezoidal and / or triangular adjustable. Device according to at least one of the preceding claims, characterized in that the segments (5) have the same shape. Device according to at least one of the preceding claims, characterized in that the object sensor (3) is a laser scanner (10). Device according to at least one of the preceding claims, characterized in that at least two object sensors (3) are provided which each detect identical segments (5) from different directions. Device according to at least one of the preceding claims, characterized in that the machine (2) is a robot. Device according to at least one of the preceding Claims 1 to 8th , characterized in that the machine (2) is a vehicle (11). Device after Claim 10 , characterized in that the vehicle (11) is a driverless autonomous vehicle (12). Device after Claim 10 to 11 , characterized in that the control signals for the vehicle (11) are steering or braking signals.

Images