DE102016218738A1 - Method for operating autonomously moving platforms and obstacle protection sensor - Google Patents
Method for operating autonomously moving platforms and obstacle protection sensor Download PDFInfo
- Publication number
- DE102016218738A1 DE102016218738A1 DE102016218738.4A DE102016218738A DE102016218738A1 DE 102016218738 A1 DE102016218738 A1 DE 102016218738A1 DE 102016218738 A DE102016218738 A DE 102016218738A DE 102016218738 A1 DE102016218738 A1 DE 102016218738A1
- Authority
- DE
- Germany
- Prior art keywords
- platform
- speed
- obstacle
- steering angle
- protection sensor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 40
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000004590 computer program Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 230000006978 adaptation Effects 0.000 claims description 5
- 238000003860 storage Methods 0.000 claims description 4
- 238000005259 measurement Methods 0.000 description 10
- 230000008901 benefit Effects 0.000 description 8
- 230000007257 malfunction Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 238000012423 maintenance Methods 0.000 description 5
- 230000001681 protective effect Effects 0.000 description 5
- 238000007796 conventional method Methods 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000002604 ultrasonography Methods 0.000 description 2
- BUHVIAUBTBOHAG-FOYDDCNASA-N (2r,3r,4s,5r)-2-[6-[[2-(3,5-dimethoxyphenyl)-2-(2-methylphenyl)ethyl]amino]purin-9-yl]-5-(hydroxymethyl)oxolane-3,4-diol Chemical compound COC1=CC(OC)=CC(C(CNC=2C=3N=CN(C=3N=CN=2)[C@H]2[C@@H]([C@H](O)[C@@H](CO)O2)O)C=2C(=CC=CC=2)C)=C1 BUHVIAUBTBOHAG-FOYDDCNASA-N 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000011017 operating method Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Bei einem Verfahren zum Betreiben von sich autonom bewegenden Plattformen mit wenigstens einem Hindernisschutzsensor wird auf der Basis von Informationen über die detektierbare Position eines Hindernisses unter Berücksichtigung des Lenkwinkels der Plattform bei Bedarf eine angepasste Soll-Geschwindigkeit (19) ermittelt und an eine Steuereinheit der Plattform ausgegeben.In a method for operating autonomously moving platforms with at least one obstacle protection sensor, on the basis of information about the detectable position of an obstacle, taking into account the steering angle of the platform, an adjusted target speed (19) is determined as required and output to a control unit of the platform ,
Description
Die vorliegende Erfindung betrifft ein Verfahren zum Betreiben von sich autonom bewegenden Plattformen mit wenigstens einem Hindernisschutzsensor, insbesondere einer Ausführung mit einem Personenschutzsensor, einen Hindernisschutzsensor selbst und eine sich autonom bewegende Plattform mit einem solchen Hindernisschutzsensor. Weiterhin betrifft die Erfindung ein Computerprogramm, ein maschinenlesbares Speichermedium und ein elektronisches Steuergerät, die zur Durchführung des Verfahrens eingerichtet sind. The present invention relates to a method for operating autonomously moving platforms with at least one obstacle protection sensor, in particular an embodiment with a personal protection sensor, an obstacle protection sensor itself and an autonomously moving platform with such an obstacle protection sensor. Furthermore, the invention relates to a computer program, a machine-readable storage medium and an electronic control unit, which are set up to carry out the method.
Stand der TechnikState of the art
In vielen Bereichen kommen sich autonom bewegende Plattformen zum Einsatz. Beispielsweise werden in Krankenhäusern oder anderen sozialen Einrichtungen autonome Transportroboter oder Serviceroboter eingesetzt, die sich frei innerhalb der Räumlichkeiten bewegen. In industriellen Fertigungshallen werden Transportsysteme mit beweglichen Einheiten (mobile Plattformen) eingesetzt. Man spricht auch von sich autonom bewegenden Flurförderzeugen. Zur Vermeidung von Kollisionen mit Hindernissen und insbesondere mit Personen sind mobile Plattformen in der Regel mit einem Hindernisschutzsensor (Personenschutzsensor) ausgerüstet. Überschreitet die mobile Plattform eine bestimmte Geschwindigkeit, beispielsweise 0,3 m/s, ist ein Personenschutzsensor vorgeschrieben, um den Fahrschlauch des Fahrzeugs bzw. der Plattform zu überwachen und bei Bedarf anhalten zu können. Hierfür tastet der Personenschutzsensor sein Umfeld mit einem geeigneten Messverfahren ab und bestimmt die Entfernung von Gegenständen und Personen im Sichtfeld des Sensors. Intern stehen dem Sensor die Entfernungen zu den Hindernissen im Sichtbereich und die Winkel, unter denen diese gemessen wurden, zur Verfügung. In many areas autonomous moving platforms are used. For example, hospitals or other social services use autonomous transport robots or service robots that move freely within the premises. Industrial production halls use mobile unit transport systems. One speaks of autonomous moving industrial trucks. To avoid collisions with obstacles and especially with people, mobile platforms are usually equipped with an obstacle protection sensor (personal protection sensor). If the mobile platform exceeds a certain speed, for example 0.3 m / s, a personal protection sensor is required in order to be able to monitor the driving path of the vehicle or the platform and stop it if necessary. For this purpose, the personal protection sensor scans its surroundings with a suitable measuring method and determines the distance of objects and persons in the field of view of the sensor. Internally, the sensor has the distances to the obstacles in the field of vision and the angles at which they were measured.
Es ist bekannt, Personenschutzsensoren zu parametrisieren, indem eine sogenannte Warnzone und eine Stoppzone in Form eines Polygons konfiguriert werden. In Abhängigkeit von der Detektion eines Hindernisses in der Warnzone oder in der Stoppzone werden unterschiedliche Aktionen durchgeführt, indem unterschiedliche Ausgänge (OSSDs – Output Signal Switching Devices) des Sensors geschaltet werden. Typischerweise wird bei der Detektion eines Hindernisses in der Stoppzone ein Relais der Plattform so geschaltet, dass die Stromzufuhr sicher getrennt wird und damit die Plattform angehalten wird. Weiterhin sind bereits Personenschutzsensoren bekannt, die als Erweiterung über Eingänge verfügen, mit denen zwischen mehreren vorab definierten Schutzfeldkonfigurationen umgeschaltet werden kann. So ist es z. B. möglich, in Abhängigkeit des Lenkwinkels der Plattform zwischen unterschiedlichen Warn- und Stoppzonen umzuschalten, um so eine besser auf die Bewegungsrichtung des Fahrzeugs ausgerichtete Konfiguration einstellen zu können. Diese Eingänge werden beispielsweise von einem sicheren Winkelgeber auf der Lenkachse der mobilen Plattform geschaltet. Die Vorab-Konfiguration der Schutzfelder erfolgt über eine Wartungsschnittstelle der mobilen Plattform, wobei es nicht möglich ist, im laufenden Betrieb die Konfiguration der Schutzfelder zu modifizieren. Auch ist die Anzahl der Schutzfelder limitiert.It is known to parameterize personal protection sensors by configuring a so-called warning zone and a stop zone in the form of a polygon. Depending on the detection of an obstacle in the warning zone or in the stop zone, different actions are performed by switching different outputs (OSSDs - Output Signal Switching Devices) of the sensor. Typically, upon detection of an obstacle in the stop zone, a relay of the platform is switched to safely disconnect power and stop the platform. Furthermore, personal protection sensors are already known, which have as an extension inputs, which can be switched between a plurality of previously defined protective field configurations. So it is z. B. possible to switch depending on the steering angle of the platform between different warning and stop zones, so as to be able to set a better aligned to the direction of movement of the vehicle configuration. These inputs are switched, for example, by a safe angle encoder on the steering axis of the mobile platform. The pre-configuration of the protective fields takes place via a maintenance interface of the mobile platform, whereby it is not possible to modify the configuration of the protective fields during operation. Also, the number of protective fields is limited.
Offenbarung der ErfindungDisclosure of the invention
Vorteile der ErfindungAdvantages of the invention
Die Erfindung stellt ein Verfahren zum Betreiben von sich autonom bewegenden Plattformen mit wenigstens einem Hindernisschutzsensor, insbesondere einem Personenschutzsensor, bereit, das im Vergleich mit herkömmlichen Verfahren wesentlich flexibler ist. Bei dem erfindungsgemäßen Verfahren wird auf der Basis von Informationen über die detektierbare Position eines Hindernisses unter Berücksichtigung des Lenkwinkels der Plattform bei Bedarf eine angepasste Soll-Geschwindigkeit für die Plattform ermittelt und an eine Steuereinheit der Plattform ausgegeben. Hierfür erhält der Hindernisschutzsensor, der für die Durchführung dieses Verfahrens eingerichtet ist und mit einer entsprechenden Recheneinheit ausgestattet ist, insbesondere von einer Steuereinheit der Plattform als Sensoreingangssignale Informationen über die Soll-Geschwindigkeit und gegebenenfalls über den Soll-Lenkwinkel der Plattform. Durch Sensorfunktionen wird ein Hindernis detektiert, sodass hieraus Informationen über die Position des Hindernisses in Bezug zur Plattform ableitbar sind. Hierbei ist der Abstand des Hindernisses zur Plattform und gegebenenfalls der Winkel des Hindernisses in Bezug zur Bewegungsrichtung der Plattform wichtig. Auf der Basis von diesen Informationen wird die Soll-Geschwindigkeit der Plattform bei Bedarf angepasst. Die Informationen über diese angepasste Soll-Geschwindigkeit werden an die Steuereinheit (Steuerung) der Plattform ausgegeben, sodass die Plattform entsprechend betrieben werden kann. Unter Soll-Geschwindigkeit ist hierbei die Soll-Höchstgeschwindigkeit zu verstehen. Der erfindungsgemäße Hindernisschutzsensor steuert damit die begrenzte Soll-Höchstgeschwindigkeit und gegebenenfalls den Soll-Lenkwinkel der Plattform, indem es die von der Bewegungssteuerung angeforderte Soll-Geschwindigkeit und gegebenenfalls den angeforderten Soll-Lenkwinkel durch eine geeignete Begrenzung anpasst. Der besondere Vorteil des erfindungsgemäßen Verfahrens liegt darin, dass bei der Entscheidung, ob die mobile Plattform gestoppt oder verlangsamt werden muss, die Fahrtrichtung berücksichtigt wird. Darüber hinaus kann die Geschwindigkeit nahezu stufenlos an die Entfernung zu vorhandenen Hindernissen angepasst werden. In die Berechnungen für die Anpassung der Soll-Geschwindigkeit und gegebenenfalls des Soll-Lenkwinkels fließen vorzugsweise auch die Ist-Geschwindigkeit und der Ist-Lenkwinkel ein. Sowohl die Ist-Geschwindigkeit als auch der Ist-Lenkwinkel werden hierfür vorzugsweise als sogenannte sichere Sensoreingangssignale zur Verfügung gestellt. "Sicher" in diesem Zusammenhang heißt, dass die Signale mit der durch anwendbare Normen geforderten Zuverlässigkeit zur Verfügung stehen. Dies kann beispielsweise bedeuten, dass es zwei Sensoren, beispielsweise zwei Lenkwinkelgeber, für denselben physikalischen Wert gibt, und dass beide Sensoren gegeneinander plausibilisiert werden, sodass feststellbar ist, ob ein Sensor defekt ist.The invention provides a method for operating autonomously moving platforms with at least one obstacle protection sensor, in particular a personal protection sensor, which is considerably more flexible in comparison with conventional methods. In the method according to the invention, on the basis of information about the detectable position of an obstacle taking into account the steering angle of the platform, if necessary, an adapted target speed for the platform is determined and output to a control unit of the platform. For this purpose, the obstacle protection sensor, which is set up for carrying out this method and is equipped with a corresponding computing unit, in particular from a control unit of the platform as sensor input signals information about the target speed and optionally on the target steering angle of the platform. Sensor functions detect an obstacle so that information about the position of the obstacle relative to the platform can be derived. Here, the distance of the obstacle to the platform and, where appropriate, the angle of the obstacle with respect to the direction of movement of the platform is important. Based on this information, the target speed of the platform is adjusted as needed. The information about this adjusted target speed is output to the control unit (controller) of the platform so that the platform can be operated accordingly. The target speed is understood here as the target maximum speed. The obstacle protection sensor according to the invention thus controls the limited set maximum speed and possibly the desired steering angle of the platform by adapting the desired speed requested by the motion control and optionally the requested desired steering angle by a suitable limitation. The particular advantage of the method according to the invention is that the direction of travel is taken into account when deciding whether the mobile platform has to be stopped or slowed down. In addition, the speed can be adjusted almost infinitely to the distance to existing obstacles. In the Calculations for the adaptation of the setpoint speed and, if appropriate, the desired steering angle preferably also flow into the actual speed and the actual steering angle. Both the actual speed and the actual steering angle are preferably provided for this purpose as so-called safe sensor input signals. "Safe" in this context means that the signals are available with the reliability required by applicable standards. This can mean, for example, that there are two sensors, for example two steering angle sensors, for the same physical value, and that both sensors are plausibilized against one another, so that it is possible to determine whether a sensor is defective.
Die Anpassung und Begrenzung der Soll-Geschwindigkeit (Soll-Höchstgeschwindigkeit) wird vorzugsweise anhand von intern verfügbaren Informationen über vorhandene Hindernisse im Umfeld der Plattform bestimmt, die in Abhängigkeit von den aktuellen Sensorsignalen abgerufen werden. Es handelt sich hierbei insbesondere um Abstands- und Winkelinformationen zu Hindernissen im Sensorsichtbereich. The adjustment and limitation of the target speed (target maximum speed) is preferably determined on the basis of internally available information about existing obstacles in the vicinity of the platform, which are retrieved as a function of the current sensor signals. These are, in particular, distance and angle information about obstacles in the sensor vision area.
Im Vergleich mit herkömmlichen Verfahren zum Betreiben von sich autonom bewegenden Plattformen wird bei dem erfindungsgemäßen Verfahren die Bewegungsrichtung der Plattform berücksichtigt, die sich in dem Lenkwinkel der Plattform widerspiegelt. Bei herkömmlichen Betriebsverfahren, die mit einer Warn- und/oder Stoppzone in der eingangs beschriebenen Weise arbeiten, tritt das Problem auf, dass bei der Detektion eines Hindernisses in der Stoppzone die Plattform zwar anhält, sich in der Regel aber erst dann wieder autonom fortbewegen kann, wenn das Hindernis aus der Stoppzone verschwunden ist, selbst wenn sich die mobile Plattform von dem Hindernis gemäß dem vorgesehenen Bewegungspfad entfernen wollte. Ist das Hindernis statisch und bewegt sich nicht aus der Stoppzone, so ist es für die weitere Bewegung der mobilen Plattform erforderlich, dass die mobile Plattform durch einen menschlichen Eingriff aus dieser Situation heraus bewegt wird. Ein selbstständiges Entfernen vom Hindernis ist nicht möglich. Prinzipiell wäre es zwar technisch möglich, durch das Schalten eines entsprechend kleineren Schutzfeldes ein Entfernen der Plattform von dem Hindernis zu ermöglichen. Ein solches Verfahren würde aber nicht die Sicherheitsanforderungen an einen Personenschutzsensor erfüllen, da die Plattformsteuerung hierfür die Rohsensordaten, also die Entfernung zum Hindernis, sofern überhaupt verfügbar, verarbeiten müsste. Eine entsprechende Schnittstelle zu diesen Daten genügt üblicherweise nicht den Sicherheitsanforderungen an einen Personenschutzsensor. Auch die Sicherheitsanforderungen an die Steuerung der mobilen Plattform wären in diesem Fall problematisch, da diese dann die sicherheitsrelevanten Eingänge des Personenschutzsensors schalten müsste. Das erfindungsgemäße Verfahren löst dieses Problem, indem auf der Basis von Informationen über die detektierbare Position eines Hindernisses unter Berücksichtigung des Lenkwinkels der Plattform die Soll-Geschwindigkeit bei Bedarf angepasst und begrenzt wird. Hierbei werden die erforderlichen Sicherheitsanforderungen erfüllt. Zugleich erlaubt das Verfahren ein wesentlich flexibleren Betrieb der heute verfügbaren Hindernisschutzsensoren oder Personenschutzsensoren, die oftmals ihren Ursprung in der Absicherung von Produktionsanlagen haben und daher im Allgemeinen prinzipiell nur bedingt für den Einbau in mobile Plattformen geeignet sind. In comparison with conventional methods for operating autonomously moving platforms, the method according to the invention takes into account the direction of movement of the platform, which is reflected in the steering angle of the platform. In conventional operating methods that operate with a warning and / or stop zone in the manner described above, the problem arises that when detecting an obstacle in the stop zone, the platform indeed stops, but usually can then move autonomously again if the obstacle has disappeared from the stop zone, even if the mobile platform wanted to move away from the obstacle according to the intended movement path. If the obstacle is static and does not move out of the stop zone, further movement of the mobile platform requires that the mobile platform be moved out of this situation by human intervention. An independent removal from the obstacle is not possible. In principle, it would be technically possible to enable removal of the platform from the obstacle by switching a correspondingly smaller protective field. However, such a method would not meet the safety requirements for a personal protection sensor, since the platform controller would have to process the raw sensor data, ie the distance to the obstacle, if at all available. A corresponding interface to this data usually does not meet the safety requirements for a personal protection sensor. The security requirements for the control of the mobile platform would be problematic in this case, since they would then switch the safety-related inputs of the personal protection sensor. The method according to the invention solves this problem by adapting and limiting the setpoint speed on demand on the basis of information about the detectable position of an obstacle taking into account the steering angle of the platform. Here, the required security requirements are met. At the same time, the method allows a much more flexible operation of today available obstacle protection sensors or personal protection sensors, which often have their origin in the protection of production facilities and therefore generally suitable in principle only to a limited extent for installation in mobile platforms.
Auch die Konfiguration von nur einer Warnzone schränkt bei herkömmlichen mobilen Plattformen die Leistungsfähigkeit des Systems ein. Für ein sicheres System ist es im Allgemeinen nicht ausreichend, nur den Fahrschlauch zu überwachen, stattdessen müssen auch Hindernisse neben dem Fahrschlauch betrachtet werden. Ansonsten kann der Fall auftreten, dass die Plattform sehr dicht an Personen neben dem Fahrschlauch vorbeifährt, sodass sie im Fall einer Fehlfunktion unter Umständen nicht rechtzeitig bremsen kann. Will man nicht die Stoppzone seitlich mehr als unbedingt notwendig ausweiten, wobei folglich mehr Abstand zu seitlichen Hindernissen eingehalten werden würde, kann nur die Warnzone dazu benutzt werden, das Fahrzeug soweit abzubremsen, dass es bei einer Fehlfunktion, beispielsweise in Bezug auf die Lenkung, rechtzeitig stoppen kann. Da jedoch nur eine einzige Warnzone vorgesehen ist und beim Betrieb auch nur signalisiert wird, dass sich etwas in der Warnzone befindet, aber nicht, wie nah ein Hindernis innerhalb der Warnzone ist, muss zwangsläufig die zulässige Höchstgeschwindigkeit bei Hindernissen in der Warnzone auf die ungünstigste Situation ausgelegt werden, also ein bereits sehr dichtes Hindernis. Die Entfernung des Hindernisses zum Fahrzeug und Fahrschlauch kann bei herkömmlichen Verfahren nicht zur Generierung von angemessenen Geschwindigkeiten verwendet werden. Das erfindungsgemäße Verfahren erlaubt der Plattform hingegen, durch eine entsprechende Anpassung der Soll-Geschwindigkeit und gegebenenfalls des Soll-Lenkwinkels unter Berücksichtigung der messbaren Position eines Hindernisses und des Lenkwinkels flexibel auf alle Vorkommnisse autonom zu reagieren. The configuration of just one warning zone also limits the performance of the system in conventional mobile platforms. For a safe system, it is generally not sufficient to monitor only the driving lane, but obstacles must also be considered next to the driving lane. Otherwise, it may happen that the platform passes very close to people next to the drive line, so that in the event of a malfunction, it may not be able to brake in time. If you do not want to extend the stop zone laterally more than absolutely necessary, thus more distance to side obstacles would be met, only the warning zone can be used to brake the vehicle so far that it in case of malfunction, for example in relation to the steering in time can stop. However, since only a single warning zone is provided and the operation only signals that something is in the warning zone, but not how close an obstacle is within the warning zone, the maximum permissible speed for obstacles in the warning zone must inevitably be at the most unfavorable situation be interpreted, so an already very dense obstacle. The removal of the obstacle to the vehicle and the travel tube can not be used to generate reasonable speeds in conventional methods. By contrast, the method according to the invention allows the platform to react flexibly to all occurrences by adapting the setpoint speed and possibly the setpoint steering angle, taking into account the measurable position of an obstacle and the steering angle.
In einer besonders bevorzugten Ausgestaltung des erfindungsgemäßen Verfahrens wird während des Betriebs der mobilen Plattform für alle messbaren bzw. detektierbaren Hindernisse im Sichtfeld des Hindernisschutzsensors eine zugehörige Kollisionsdistanz bestimmt. Für die Ermittlung einer maximalen Geschwindigkeit der Plattform wird die geringste Kollisionsdistanz, die für eines der Hindernisse im Sichtbereich des Sensors festgestellt wird, herangezogen. In dem Fall, in dem die maximale Geschwindigkeit (Höchstgeschwindigkeit) die vorgesehene Soll-Geschwindigkeit unterschreitet, erfolgt eine Anpassung der Soll-Geschwindigkeit (Höchstgeschwindigkeit) auf die maximale Geschwindigkeit. Die Anpassung der Soll-Geschwindigkeit erfolgt also nur bei Bedarf. Die angepasste Soll-Geschwindigkeit wird für den Betrieb der Plattform zur Verfügung gestellt und an die Steuereinheit weitergeleitet. Die Anpassung der Soll-Geschwindigkeit erfolgt also anhand von verfügbaren Abstands- und Winkelinformationen zu den vorhandenen Hindernissen im Sensorsichtbereich. Hierbei werden vorzugsweise auch die Ist-Geschwindigkeit und der Sollwert-Lenkwinkel berücksichtigt. In a particularly preferred embodiment of the method according to the invention, an associated collision distance is determined during operation of the mobile platform for all measurable or detectable obstacles in the field of view of the obstacle protection sensor. For the determination of a maximum speed of the platform, the lowest collision distance, which for one of the Obstacles in the field of view of the sensor is detected, used. In the case where the maximum speed (maximum speed) falls below the intended target speed, the target speed (maximum speed) is adapted to the maximum speed. The adjustment of the target speed is therefore only on demand. The adjusted target speed is made available for operation of the platform and forwarded to the control unit. The adjustment of the target speed thus takes place on the basis of available distance and angle information about the existing obstacles in the sensor sight area. In this case, the actual speed and the setpoint steering angle are preferably taken into account as well.
In besonders bevorzugter Weise werden für die Anpassung der Soll-Geschwindigkeit und gegebenenfalls des Soll-Lenkwinkels hinterlegte Wertebeziehungen herangezogen. Hierbei werden vorzugsweise offline berechnete Tabellen verwendet, die über eine entsprechende Wartungsschnittstelle abgesichert in eine Recheneinheit des Hindernisschutzsensors übertragen und abgelegt werden können. Vorzugsweise bilden die Wertebeziehungen den Raum um die Plattform und den Lenkwinkel der Plattform unter Berücksichtigung der Plattformkontur ab. Hierbei können in tabellarischer Weise Positionsdaten des jeweiligen Hindernisses zusammen mit dem Lenkwinkel der Plattform (als dritte Dimension) mit einer entsprechenden Kollisionsdistanz in Beziehung gesetzt werden, sodass bei Kenntnis der Positionsdaten und des jeweiligen Lenkwinkels die Kollisionsdistanz abgerufen werden kann. Mit dem Ausdruck "Raum" kann hierbei beispielsweise der kartesische Raum oder ein anderer metrischer Raum, beispielsweise ein Geschwindigkeitsraum, gemeint sein. Die Wertebeziehungen werden also mit besonderem Vorteil für die Bestimmung der Kollisionsdistanzen zu den detektierbaren Hindernissen herangezogen. „Detektierbar“ in diesem Zusammenhang bedeutet, dass sich das Hindernis im Sichtfeld des Hindernisschutzsensors befindet und von dem entsprechenden Sensor überhaupt erfasst werden kann. Der eigentliche Sensor kann in den Hindernisschutzsensor integriert sein. Weiterhin ist es möglich, dass der Hindernisschutzsensor mittels einer geeigneten Schnittstelle auf Messdaten eines externen Sensors zurückgreift. Das Messprinzip des Hindernisschutzsensors kann beispielsweise auf der Laufzeitmessung eines reflektierten Laserstahls oder eines Ultraschallsignals oder eines Radarsignals beruhen. Weiterhin ist es möglich, dass das Messprinzip auf der Triangulation eines reflektierten Infrarotstrahls beruht. Prinzipiell ist das erfindungsgemäße Verfahren für den Betrieb der verschiedenen üblichen Hindernisschutzsensoren und insbesondere Personenschutzsensoren, die für den Betrieb von mobilen Plattformen eingesetzt werden, geeignet. In a particularly preferred manner, stored value relationships are used for the adaptation of the setpoint speed and, if appropriate, the desired steering angle. In this case, tables that are calculated offline are preferably used, which can be transferred to and stored in a computing unit of the obstacle protection sensor via a corresponding maintenance interface. The value relationships preferably form the space around the platform and the steering angle of the platform, taking into account the platform contour. In this case, position data of the respective obstacle together with the steering angle of the platform (as a third dimension) can be related in tabular fashion to a corresponding collision distance, so that the collision distance can be retrieved with knowledge of the position data and the respective steering angle. By the term "space" may be meant, for example, the Cartesian space or another metric space, for example a speed space. The value relationships are thus used with particular advantage for the determination of the collision distances to the detectable obstacles. "Detectable" in this context means that the obstacle is in the field of view of the obstacle protection sensor and can be detected by the corresponding sensor at all. The actual sensor can be integrated in the obstacle protection sensor. Furthermore, it is possible for the obstacle protection sensor to resort to measurement data of an external sensor by means of a suitable interface. The measuring principle of the obstacle protection sensor can be based for example on the transit time measurement of a reflected laser beam or an ultrasonic signal or a radar signal. Furthermore, it is possible that the measurement principle based on the triangulation of a reflected infrared beam. In principle, the method according to the invention is suitable for the operation of the various conventional obstacle protection sensors and in particular personal protection sensors which are used for the operation of mobile platforms.
In einer besonders bevorzugten Ausgestaltung des erfindungsgemäßen Verfahrens können verschiedene Plausibilisierungen von Soll-Werten und Ist-Werten, insbesondere in Bezug auf die Geschwindigkeit und den Lenkwinkel der Plattform, vorgenommen werden. Bei einer nicht plausiblen Beziehung zwischen Soll-Werten und Ist-Werten erfolgt zweckmäßigerweise ein Abschalten der Plattform, da in solchen Fällen eine Fehlfunktion zu befürchten ist, die schwerwiegende Folgen, beispielsweise eine Kollision mit Menschen, nach sich ziehen kann. Das Abschalten des Antriebs bzw. der Motoren der Plattform kann über entsprechende Schnittstellen erfolgen. Der Hindernisschutzsensor kann dabei verschiedene Ein- und Ausgänge gegeneinander plausibilisieren. Beispielsweise kann die Ist-Geschwindigkeit durch Vergleich mit der Soll-Geschwindigkeit plausibilisiert werden, wobei die Ist-Geschwindigkeit nur um einen bestimmten Betrag von der aktuellen Soll-Geschwindigkeit abweichen sollte (Schleppabstand). Weiterhin kann überprüft werden, ob eine erfindungsgemäße Anpassung der Soll-Geschwindigkeit eine entsprechende Änderung bei der Ist-Geschwindigkeit nach sich zieht. In Bezug auf den Lenkwinkel kann in entsprechender Weise überprüft werden, ob eine Anpassung des Soll-Lenkwinkels eine entsprechende Änderung des Ist-Lenkwinkels nach sich zieht. Auf diese Weise können Fehlfunktionen erkannt werden und die Plattform aus Sicherheitsgründen angehalten bzw. stillgelegt wird. In a particularly preferred embodiment of the method according to the invention, various plausibility checks of desired values and actual values, in particular with regard to the speed and the steering angle of the platform, can be carried out. In the case of an implausible relationship between setpoint values and actual values, it is expedient to switch off the platform, since in such cases a malfunction is to be feared which can lead to serious consequences, for example a collision with humans. The shutdown of the drive or the motors of the platform can be done via appropriate interfaces. The obstacle protection sensor can plausibilize different inputs and outputs. For example, the actual speed can be made plausible by comparison with the setpoint speed, wherein the actual speed should only deviate from the current setpoint speed by a certain amount (following error). Furthermore, it can be checked whether an adaptation according to the invention of the setpoint speed results in a corresponding change in the actual speed. In relation to the steering angle can be checked in a corresponding manner, whether an adjustment of the target steering angle pulls a corresponding change in the actual steering angle by itself. In this way, malfunctions can be detected and the platform is stopped or shut down for security reasons.
Bei dem erfindungsgemäßen Verfahren ist in erster Linie, wie beschrieben, eine Anpassung der Soll-Geschwindigkeit vorgesehen. Prinzipiell ist es auch möglich, den Soll-Lenkwinkel anzupassen. Diese Ausgestaltung ist zwar etwas komplexer, aber diese Ausgestaltung kann insbesondere dann sinnvoll sein, wenn sich mit dem angegebenen Soll-Lenkwinkel eine Kollision nicht mehr vermeiden ließe und daher beispielsweise der Ist-Lenkwinkel vorzuziehen wäre.In the method according to the invention, an adaptation of the desired speed is primarily provided, as described. In principle, it is also possible to adjust the target steering angle. Although this embodiment is somewhat more complex, but this configuration may be useful in particular if a collision with the specified target steering angle could not be avoided and therefore, for example, the actual steering angle would be preferable.
Die Erfindung umfasst weiterhin einen Hindernisschutzsensor, insbesondere einen Personenschutzsensor, zum Einsatz in einer sich autonom bewegenden (mobilen) Plattform. Der Hindernisschutzsensor umfasst zunächst eine Recheneinheit. Weiterhin sind ein Eingang für die Soll-Geschwindigkeit und ein Eingang für den Soll-Lenkwinkel und/oder den Ist-Lenkwinkel der Plattform vorgesehen. Weiterhin umfasst der Hindernisschutzsensor einen Ausgang für eine angepasste Soll-Geschwindigkeit, die in der Recheneinheit ermittelt wird, und einen Ausgang für ein Abschalten der Plattform. Zusätzlich kann ein Eingang für die Ist-Geschwindigkeit vorhanden sein. Weiterhin weist der erfindungsgemäße Hindernisschutzsensor eine Einrichtung zur Bereitstellung von Informationen über die Position eines Hindernisses im Sichtfeld des Sensors auf. Hierfür kann insbesondere eine entsprechende Messeinrichtung, also ein eigentlicher Sensor, oder gegebenenfalls eine Schnittstelle für entsprechende Messdaten, die von einem externen Sensor erfasst werden, vorgesehen sein. Die Messdaten in Bezug auf die Hindernisse im Sichtfeld des Sensors können mit an sich bekannten Messprinzipien erfasst werden, beispielsweise mit einer Laufzeitmessung eines reflektierten Laserstrahls oder basierend auf einem Ultraschall- oder Radarsignal oder auf der Basis einer Triangulation eines reflektierten Infrarotstrahls. Die Recheneinheit des Hindernisschutzsensors ist vorzugsweise für die Durchführung des beschriebenen Verfahrens eingerichtet. Hierfür können in der Recheneinheit Wertebeziehungen und Informationen hinterlegt sein, die für die Berechnung der angepassten Soll-Geschwindigkeit und gegebenenfalls des angepassten Soll-Lenkwinkels der Plattform herangezogen werden. Bezüglich des Verfahrens zum Betreiben der Plattform, das mit Hilfe dieser Recheneinheit durchgeführt wird, wird auf die obige Beschreibung verwiesen. Die Wertebeziehungen und weiteren Informationen für die Durchführung des Verfahrens können über eine entsprechende Wartungsschnittstelle auf die Recheneinheit übertragen werden. Vorzugsweise ist für ein sicheres Überspielen der Daten auf die Recheneinheit eine Prüfsumme vorgesehen, sodass mit Hilfe der Prüfsumme die Recheneinheit überprüfen kann, ob die entsprechenden Daten, beispielsweise die tabellenförmigen Wertebeziehungen, korrekt übertragen und in einem Speicher der Recheneinheit abgelegt worden sind. The invention further comprises an obstacle protection sensor, in particular a personal protection sensor, for use in an autonomously moving (mobile) platform. The obstacle protection sensor initially comprises a computing unit. Furthermore, an input for the desired speed and an input for the desired steering angle and / or the actual steering angle of the platform are provided. Furthermore, the obstacle protection sensor comprises an output for a customized target speed, which is determined in the arithmetic unit, and an output for switching off the platform. In addition, an input for the actual speed may be present. Furthermore, the obstacle protection sensor according to the invention has a device for providing information about the position of an obstacle in the field of view of the sensor. For this purpose, in particular a corresponding measuring device, Thus, an actual sensor, or possibly an interface for corresponding measurement data, which are detected by an external sensor, be provided. The measurement data relating to the obstacles in the field of view of the sensor can be detected by measurement principles known per se, for example with a transit time measurement of a reflected laser beam or based on an ultrasound or radar signal or on the basis of a triangulation of a reflected infrared beam. The arithmetic unit of the obstacle protection sensor is preferably set up for carrying out the described method. For this purpose, value relationships and information can be stored in the arithmetic unit, which are used for the calculation of the adjusted target speed and, if appropriate, the adjusted target steering angle of the platform. With regard to the method for operating the platform, which is carried out with the aid of this arithmetic unit, reference is made to the above description. The value relationships and further information for carrying out the method can be transmitted to the arithmetic unit via a corresponding maintenance interface. Preferably, a check sum is provided for a secure dubbing of the data on the arithmetic unit, so that the arithmetic unit can check with the aid of the checksum whether the corresponding data, for example the table-shaped value relationships, have been correctly transferred and stored in a memory of the arithmetic unit.
Weiterhin umfasst die Erfindung eine sich autonom bewegende Plattform, die mit wenigstens einem Hindernisschutzsensor gemäß der obigen Beschreibung ausgestattet ist. Furthermore, the invention comprises an autonomously moving platform equipped with at least one obstacle protection sensor as described above.
Schließlich umfasst die Erfindung ein Computerprogramm, das zur Durchführung der Schritte des beschriebenen Verfahrens eingerichtet ist, sowie ein maschinenlesbares Speichermedium, auf welchem ein solches Computerprogramm gespeichert ist, und ein elektronisches Steuergerät, das zur Durchführung der Schritte des beschriebenen Verfahrens eingerichtet ist. Der Vorteil der Realisierung des erfindungsgemäßen Verfahrens als Computerprogramm bzw. als maschinenlesbares Speichermedium oder als elektronisches Steuergerät hat den besonderen Vorteil, dass damit die Vorteile des erfindungsgemäßen Verfahrens durch einfaches Aufspielen des Computerprogramms oder durch entsprechende Anpassung des jeweiligen Steuergeräts auch bei bestehenden Plattformen genutzt werden können. Finally, the invention comprises a computer program, which is set up to carry out the steps of the method described, and a machine-readable storage medium, on which such a computer program is stored, and an electronic control device, which is set up to carry out the steps of the described method. The advantage of realizing the method according to the invention as a computer program or as a machine-readable storage medium or as an electronic control unit has the particular advantage that the advantages of the method according to the invention can be utilized by simply loading the computer program or by adapting the respective control unit to existing platforms.
Weitere Merkmale und Vorteile der Erfindung ergeben sich aus der nachfolgenden Beschreibung von Ausführungsbeispielen in Verbindung mit den Zeichnungen. Hierbei können die einzelnen Merkmale jeweils für sich oder in Kombination miteinander verwirklicht sein. Further features and advantages of the invention will become apparent from the following description of exemplary embodiments in conjunction with the drawings. In this case, the individual features can be implemented individually or in combination with each other.
In den Zeichnungen zeigen:In the drawings show:
Beschreibung von AusführungsbeispielenDescription of exemplary embodiments
Bei der Durchführung des erfindungsgemäßen Verfahrens werden auf der Basis von Informationen über die detektierbare Position eines Hindernisses, die mit Hilfe der Messeinrichtung
Die Berechnung der Kollisionsdistanzen erfolgt vorzugsweise unter Berücksichtigung von Wertebeziehungen, die insbesondere als vorab berechnete Tabellen bereitgestellt werden.
Im Betrieb berechnet die Recheneinheit
Im Betrieb der Plattform
Je nach Ausführungsform der Tabelle sollte die Position des Hindernisses in dem richtigen Bezugssystem vorliegen. Der besondere Vorteil der Nutzung von vorab berechneten Tabellen liegt darin, dass während des laufenden Betriebs durch die Recheneinheit
Das Hindernis mit der geringsten Kollisionsdistanz d = min dn (n = 1...h) bestimmt die maximale Geschwindigkeit bzw. die maximale Höchstgeschwindigkeit v. Ist die aktuelle Soll-Geschwindigkeit höher als die berechnete Höchstgeschwindigkeit v, wird v als angepasste bzw. begrenzte Soll-Geschwindigkeit anstelle der ursprünglich vorgesehenen Soll-Geschwindigkeit an die Steuerung der Plattform weitergegeben. Mit Hilfe einer konfigurierbaren Bremsbeschleunigung a lässt sich v beispielsweise wie folgt berechnen:
Dabei ist s ein Sicherheitsabstand, der zum Hindernis eingehalten werden soll. d ist die Kollisionsdistanz.
ZITATE ENTHALTEN IN DER BESCHREIBUNG QUOTES INCLUDE IN THE DESCRIPTION
Diese Liste der vom Anmelder aufgeführten Dokumente wurde automatisiert erzeugt und ist ausschließlich zur besseren Information des Lesers aufgenommen. Die Liste ist nicht Bestandteil der deutschen Patent- bzw. Gebrauchsmusteranmeldung. Das DPMA übernimmt keinerlei Haftung für etwaige Fehler oder Auslassungen.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.
Zitierte Nicht-PatentliteraturCited non-patent literature
- „Christian Schlegel: Fast local obstacle avoidance under kinematic and dynamic constraints for a mobile robot. In: Proceedings Int. Conf. on Intelligent Robots and Systems (IROS), Seiten 594–599, Victoria, Canada, 1998“ [0027] "Christian Schlegel: Fast local obstacle avoidance under kinematic and dynamic constraints for a mobile robot. In: Proceedings Int. Conf. on Intelligent Robots and Systems (IROS), pp. 594-599, Victoria, Canada, 1998 " [0027]
Claims (14)
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102016218738.4A DE102016218738A1 (en) | 2016-09-28 | 2016-09-28 | Method for operating autonomously moving platforms and obstacle protection sensor |
PCT/EP2017/073968 WO2018060060A1 (en) | 2016-09-28 | 2017-09-22 | Method for operating autonomously moving platforms and obstacle protection sensor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102016218738.4A DE102016218738A1 (en) | 2016-09-28 | 2016-09-28 | Method for operating autonomously moving platforms and obstacle protection sensor |
Publications (1)
Publication Number | Publication Date |
---|---|
DE102016218738A1 true DE102016218738A1 (en) | 2018-03-29 |
Family
ID=60001885
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE102016218738.4A Withdrawn DE102016218738A1 (en) | 2016-09-28 | 2016-09-28 | Method for operating autonomously moving platforms and obstacle protection sensor |
Country Status (2)
Country | Link |
---|---|
DE (1) | DE102016218738A1 (en) |
WO (1) | WO2018060060A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109753070A (en) * | 2019-01-16 | 2019-05-14 | 深圳市海柔创新科技有限公司 | A kind of barrier-avoiding method, device and storage robot |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20200019192A1 (en) * | 2018-07-13 | 2020-01-16 | Caterpillar Paving Products Inc. | Object detection and implement position detection system |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2101193A1 (en) | 2008-03-10 | 2009-09-16 | Sick Ag | Security system for contactless measurement of positions, paths and speeds |
DE102014206086A1 (en) | 2014-03-31 | 2015-10-01 | Robert Bosch Gmbh | Method for operating a self-propelled mobile platform |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102010012750A1 (en) * | 2010-03-25 | 2011-09-29 | Kuka Laboratories Gmbh | Method for operating a holonomic / omnidirectional industrial truck |
US9229450B2 (en) * | 2011-05-31 | 2016-01-05 | Hitachi, Ltd. | Autonomous movement system |
-
2016
- 2016-09-28 DE DE102016218738.4A patent/DE102016218738A1/en not_active Withdrawn
-
2017
- 2017-09-22 WO PCT/EP2017/073968 patent/WO2018060060A1/en active Application Filing
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2101193A1 (en) | 2008-03-10 | 2009-09-16 | Sick Ag | Security system for contactless measurement of positions, paths and speeds |
DE102014206086A1 (en) | 2014-03-31 | 2015-10-01 | Robert Bosch Gmbh | Method for operating a self-propelled mobile platform |
Non-Patent Citations (1)
Title |
---|
„Christian Schlegel: Fast local obstacle avoidance under kinematic and dynamic constraints for a mobile robot. In: Proceedings Int. Conf. on Intelligent Robots and Systems (IROS), Seiten 594–599, Victoria, Canada, 1998" |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109753070A (en) * | 2019-01-16 | 2019-05-14 | 深圳市海柔创新科技有限公司 | A kind of barrier-avoiding method, device and storage robot |
Also Published As
Publication number | Publication date |
---|---|
WO2018060060A1 (en) | 2018-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3365211B1 (en) | Method and device for reducing the risk of collision of a motor vehicle with an object | |
EP2838698B2 (en) | Robot arrangement and method for controlling a robot | |
EP3016827B1 (en) | Method and device for operating a motor vehicle in an automated driving mode | |
EP3455153B1 (en) | Method and system for avoiding collisions by cranes | |
WO2015197251A1 (en) | Device and method for operating a vehicle | |
EP3552921B1 (en) | Autonomous speed planning of a mobile actor limited to a predetermined path | |
DE102016200734A1 (en) | Method and device for monitoring a driverless driving a motor vehicle within a parking lot | |
EP3181421A1 (en) | Method and system for automatically guiding a follow vehicle with a front vehicle | |
EP3347787A1 (en) | Method and device for operating a vehicle | |
DE102015224641A1 (en) | A method for detecting a collision of a robot arm with an object and robot with a robot arm | |
EP2302416A1 (en) | Safety scanner | |
EP3365739B1 (en) | Method for driving a motor vehicle at least partially autonomously and motor vehicle | |
DE102014206086A1 (en) | Method for operating a self-propelled mobile platform | |
EP2428862A1 (en) | Device and method for safety control of a vehicle | |
EP3415286A1 (en) | Monitoring of a robot | |
DE102016218738A1 (en) | Method for operating autonomously moving platforms and obstacle protection sensor | |
WO2020165058A1 (en) | System and method for the safe operation of an automated vehicle | |
DE102015215101A1 (en) | Method and system for operating a self-contained mobile platform | |
DE102017216088A1 (en) | Control system for steering a towing vehicle with a trailer | |
EP3365140A1 (en) | Verification of a position of a manipulator system | |
DE102012108418A1 (en) | Device for enabling secure collaboration between human and selective complaint articulated arm robot, used in e.g. industrial automation field, has robotic controller having control unit connected in series with servo axle amplifiers | |
EP3377715B1 (en) | Method for controlling a vehicle, which moves autonomously within an operating environment and structure therefore | |
EP3244981B1 (en) | Amusement ride having a robot assembly | |
DE102015220644A1 (en) | Method and apparatus for determining whether a performance of one or more security actions to reduce a collision risk of a collision of a motor vehicle with an object must be controlled | |
DE202017001537U1 (en) | Safety device for a vehicle, in particular for a driverless vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R163 | Identified publications notified | ||
R005 | Application deemed withdrawn due to failure to request examination |