Pose-Parameterized Motion Planning and CBF-QP Self-Collision Filtering for a Long-Reach Drilling Boom

Stellen Sie sich eine Welt vor, in der riesige, hydraulische Maschinen die schwere Arbeit in den dunklen, staubigen Tunneln der Erde verrichten. Dies sind nicht nur einfache Bohrer; es sind komplexe, mehrgliedrige Arme, ähnlich einem menschlichen Arm mit zusätzlichen Ellenbogen und Schultern, die darauf ausgelegt sind, präzise Löcher in Gestein für den Bergbau oder den Tunnelbau zu bohren. Die Herausforderung besteht nicht nur darin, den Arm zu bewegen; es geht darum, ihn zu bewegen, ohne dass sich der Arm selbst im Weg steht. Genau wie ein Akrobat, der versucht, seine Zehen zu berühren, während er eine lange Stange hält, können die Körperteile der Maschine – ihr Ausleger, ihr Gehäuse, ihr langer Stab – zusammenstoßen, wenn die Maschine sich zu schnell bewegt oder einen schlechten Pfad wählt. Dies ist das Reich der Robotik und Automatisierung, ein Fachgebiet, das sich damit beschäftigt, Maschinen beizubringen, sich sicher und intelligent zu bewegen. Der Grundgedanke hierbei ist simpel: Wie bringen wir einer Maschine bei, von Punkt A nach Punkt B zu gelangen, ohne dass sie sich in ihren eigenen Gliedmaßen verheddert, besonders wenn sie dies immer und immer wieder in einem engen Raum tun muss?

Diese Arbeit befasst sich genau mit diesem Problem für eine spezifische, massive Maschine namens Sandvik SB60, einen Bohrarm für den Untertagebau. Die Forscher wollten diese Maschine autonomer machen, was bedeutet, dass sie ihre Bewegungen selbst planen kann, ohne dass ein menschlicher Bediener ständig zusehen muss, um Kollisionen zu verhindern. Sie entwickelten ein zweiteiliges Sicherheitssystem. Zuerst erstellten sie einen „Planer“, der eine Route kartiert und vorausblickt, um zu sehen, ob der Weg frei ist. Zweitens fügten sie einen „Sicherheitsfilter“ hinzu, der wie ein superschneller Reflex wirkt und jede Millisekunde prüft, ob die Maschine kurz vor einem Zusammenstoß steht. Sie testeten dieses System in einer hochdetaillierten Computersimulation der realen Maschine. Die Ergebnisse waren vielversprechend: Das System führte die Maschine erfolgreich durch eine Reihe komplexer Bohraufgaben, vermied Selbstkollisionen und traf ihre Ziele mit Millimetergenauigkeit, und das ohne einen einzigen Crash in der Simulation.

Das Problem: Ein riesiger Arm, der über seine eigenen Füße stolpert

Betrachten Sie die Sandvik SB60 als einen riesigen, hydraulischen Oktopusarm, der auf einem Lkw lebt. Ihre Aufgabe ist es, Löcher in die Felswand eines Tunnels zu bohren. Sie besitzt acht verschiedene Gelenke, die schwingen, heben, ausfahren und drehen können. Da sie so viele Gelenke hat, ist sie unglaublich flexibel, aber diese Flexibilität ist ein zweischneidiges Schwert. Wenn der Arm von einem Bohrpunkt zum nächsten wandern muss, könnte der lange Stab am Ende so weit ausschwingen, dass er gegen die Basis des Arms oder den Lkw selbst prallt.

In den alten Tagen beobachtete ein menschlicher Bediener den Bildschirm, sah, dass der Arm zu nah an eine Kollision geriet, und drückte die Bremse oder steuerte ihn herum. Aber Menschen werden müde und können nicht sofort reagieren. Das Ziel dieser Forschung war es, der Maschine beizubringen, ihr eigener Pilot zu sein, indem sie potenzielle Kollisionen selbst erkennt, bevor sie passieren, und automatisch um sie herumsteuert.

Die Lösung: Ein Routenplaner und ein Reflex-Wächter

Die Autoren bauten ein zweischichtiges Sicherheitsnetz, um dies zu lösen. Man kann sich das wie die Planung eines Roadtrips vorstellen, bei dem man dann einen nervösen Beifahrer hat, der jede Sekunde in den Rückspiegel schaut.

1. Der Routenplaner (Der Offline-Planer)
Bevor die Maschine überhaupt zu bewegen beginnt, betrachtet der „Routenplaner“ das Ziel. Er fragt: „Wenn ich direkt dorthin gehe, kollidiere ich dann mit mir selbst?“ Um dies zu beantworten, verwendet er ein vereinfachtes Modell der Maschine, zerlegt den langen Bohrstab in 16 winzige Segmente und prüft, wie nah jedes Segment dem Rest des Körpers kommt. Er fand 23 spezifische „Gefahrenzonen“, auf die zu achten ist. Wenn der direkte Pfad riskant aussieht, sagt der Planer nicht einfach nur „Stopp“. Er erfindet einen Umweg. Er wählt einen neuen Punkt in der Luft, hebt den Arm höher (wie ein Vogel, der über einen Zaun fliegt) und erstellt einen neuen Pfad, der um die Gefahr herumführt. Dies geschieht, bevor sich die Maschine bewegt, also ist es so, als würde man eine neue Route auf einer Karte zeichnen, bevor man losfährt.

2. Der Reflex-Wächter (Der Online CBF-QP)
Sobald die Maschine sich in Bewegung setzt, übernimmt der „Reflex-Wächter“. Dies ist der Teil, der in Echtzeit arbeitet und die Position der Maschine 200 Mal pro Sekunde (alle 5 Millisekunden) überprüft. Er verwendet ein detaillierteres Modell und behandelt die Maschine als neun distinkte „Kapseln“ (stellen Sie sich diese wie Hot-Dog-Formen mit abgerundeten Enden vor). Er prüft 14 spezifische Paare dieser Kapseln, um zu sehen, ob sie sich zu nahe kommen.

Wenn die Maschine beginnt, in Richtung einer Kollision zu driften, stoppt dieser Wächter die Maschine nicht einfach nur; er stößt die Gelenke sanft an, um wegzusteuern, während er gleichzeitig versucht, das Ziel zu erreichen. Er verwendet einen mathematischen Trick namens „Control Barrier Function“ (CBF), was wie ein unsichtbares Kraftfeld wirkt. Solange sich die Maschine außerhalb des Kraftfeldes befindet, ist sie sicher. Wenn sie zu nah kommt, zwingt die Mathematik die Maschine, die Richtung sofort zu ändern. Dieser Wächter ist klug genug zu wissen, dass er nicht eingreifen muss, wenn die Maschine bereits sicher ist, wodurch die Maschine reibungslos weiterfahren kann.

Die Testfahrt: Eine Simulation des Erfolgs

Um zu sehen, ob dieses System tatsächlich funktionierte, verwendeten die Forscher keine echte, teure Maschine in einem echten Tunnel. Stattdessen bauten sie einen perfekten digitalen Zwilling der Sandvik SB60 in einem Computerprogramm namens Simscape Multibody auf. Diese Simulation ist so detailliert, dass sie die Physik der Hydraulikflüssigkeiten und das Gewicht der Metallteile nachahmt.

Sie stellst zwei verschiedene Herausforderungen auf:

• Herausforderung 1: Eine Tour mit fünf Stopps, bei der die Maschine Löcher an verschiedenen Stellen bohren musste, wobei der Winkel des Bohrers jedoch gleich bleiben musste. Dies war vergleichbar mit einem Lieferfahrer, der fünf Stopps in einer Nachbarschaft macht.
• Herausforderung 2: Eine Tour mit drei Stopps, bei der die Maschine sowohl ihre Position als auch ihren Winkel komplett ändern musste. Dies war vergleichbar mit einer Turnerin, die eine komplexe Übung absolviert, sich dabei in jede Richtung dreht und wendet.

Die Ergebnisse
Die Ergebnisse waren beeindruckend, zumindest innerhalb der Welt der Simulation.

• Null Kollisionen: In der ersten Herausforderung generierte das System 13 Umweg-Wegpunkte, um Selbstkollisionen zu vermeiden. Es durchlief 299.757 Kontrollproben (über 24 Minuten simulierte Zeit) und versagte kein einziges Mal dabei, eine Lösung zu finden.
• Millimetergenaue Präzision: Die Maschine landete auf ihren Zielen mit einem durchschnittlichen Fehler von nur 4,42 Millimetern. Das ist weniger als die Breite eines Bleistierzellradierers.
• Sicherheitsabstände: Der „Reflex-Wächter“ hielt die Maschine sicher. In der ersten Herausforderung kam die Maschine einer Kollision am nächsten mit einem winzigen Bruchteil eines Millimeters (etwa -0,002 mm, was die Autoren als wahrscheinlich nur einen kleinen Computer-Rundungsfehler einstufen, nicht einen echten Crash). In der zweiten Herausforderung blieb die Maschine volle 31,658 Millimeter von jeder Gefahrenzone entfernt.

Was dies bedeutet (und was es nicht bedeutet)

Die Autoren sind sehr vorsichtig darin, was ihre Ergebnisse bedeuten. Sie haben bewiesen, dass ihr zweiteiliges System in der Computersimulation funktioniert. Der „Routenplaner“ hat erfolgreich sichere Routen geplant, und der „Reflex-Wächter“ hat erfolgreich in Echtzeit verhindert, dass die Maschine mit sich selbst kollidiert.

Sie schließen jedoch auch einige Dinge aus. Sie haben noch nicht bewiesen, dass dies auf einer echten Maschine in einem echten Tunnel funktioniert. Die Simulation ist ein Modell, und echte Maschinen haben Unwägbarkeiten wie Hydraulikleckagen, Sensorrauschen und das Biegen von Metall, die Computer nicht immer perfekt vorhersagen können. Sie merkten auch an, dass wenn man den „Routenplaner“ entfernt und nur den „Reflex-Wächter“ nutzt, die Maschine zwar immer noch funktioniert, aber etwas weniger genau wird (der Fehler steigt auf etwa 39 mm). Dies deutet darauf hin, dass die Kombination aus dem vorab geplanten Umweg und dem Echtzeit-Reflex die beste Lösung ist.

Kurz gesagt zeigt diese Arbeit, dass wir einen riesigen, komplexen Bohrmast lehren können, sein eigener Sicherheitsbeauftragter zu sein. Durch die Kombination eines intelligenten Planers, der eine sichere Route zeichnet, und eines blitzschnellen Wächters, der nach Problemen Ausschau hält, kann sich die Maschine autonom bewegen, ohne über ihre eigenen Gliedmaßen zu stolpern. Dies ist ein großer Schritt in Richtung einer sichereren und schnelleren Untertagebauweise, auch wenn der abschließende Test auf einer echten Maschine noch auf die Zukunft wartet.