DR-IPC: Störungsrobuste integrierte Planung und Regelung für LiDAR-basierte Quadrotor-Navigation
Das Paper stellt mit DR-IPC eine Methode vor, die A*-Pfadreferenzen, weiche Safe-Flight-Corridor-Strafen, nichtlineare Quadrotordynamik und rekonstruierte Störungen in einem einzigen NMPC-Backend vereint. In Gazebo steigert DR-IPC die Zahl abgeschlossener Multi-Goal-Missionen unter Störungen von 1/10 auf 9/10 und reduziert in Experimenten den Höhen-RMSE von 0,34 m auf 0,01 m. Der Ansatz läuft laut Preprint vollständig onboard mit 100 Hz.
Wie lässt sich die LiDAR-basierte Navigation von Quadrotoren in engen, verrauschten und störungsreichen Umgebungen verbessern, indem lokale Bewegungsplanung, Störungsschätzung und prädiktive Regelung gemeinsam optimiert werden?
LiDAR-Karten enthalten nur geometrische Information und erfassen weder Wind, payload-bedingte Kräfte noch Modellfehler; Odometrierauschen verschlechtert zudem die Zustandsmessung. In klassischen hierarchischen Architekturen optimiert der Planer kollisionsfreie Wege, während der Regler ohne Hindernisinformation Trackingfehler ausgleicht und das Fahrzeug nach Störungen in Hindernisse drängen kann. Bestehende integrierte Ansätze berücksichtigen Störungen nicht aktiv in der Prädiktion oder nutzen harte SFC-Bedingungen, die bei Störungen unzulässig oder aggressiv werden.
Hierarchische Verfahren wie SFC-basierte Polynomoptimierung, Minimum-snap, EGO-Planner oder zweistufige MPC trennen Planung und Regelung; der Regler kennt keine Hindernisse und reagiert nur passiv auf Abweichungen. Integrierte Ansätze wie Obstacle-aware NMPC, CBF-MPC, MPCC und das klassische IPC koppeln lokale Bahn und Stellgrößen, verwenden aber oft lineare Modelle, harte SFC-Nebenbedingungen und keine Online-Störungsschätzung. Störungsbeobachter-basierte MPC-Verfahren wie DA-MPC oder DR-MPC rekonstruieren Störungen, dienen jedoch meist nur der Trajektorien- oder Sichtverfolgung ohne Hindernisinformation.
DR-IPC erweitert das klassische IPC um einen nichtlinearen, verschränkten Beobachter aus EKF und NDO. Der EKF filtert die LiDAR-Inertial-Odometrie und nutzt die rekonstruierte Störung in der Prädiktion, der reduzierte NDO verwendet die gefilterten Zustände zur Störschätzung. Das NMPC-Backend optimiert direkt Winkelgeschwindigkeit und Schub, modelliert die nichtlineare Quaternion-Dynamik, berücksichtigt Aktuatorgrenzen, A*-Pfadreferenzen und bestraft SFC-Verletzungen weich statt als harte Bedingung. Die Störung wird über den Horizont konstant gehalten; ein separater Trajektorienoptimierungsschritt entfällt. Das Gesamtsystem läuft onboard mit 100 Hz.
Im Gazebo-Engpass unter konstantem Wind kollidiert IPC zweimal und fällt auf 0,042 m Höhe, während DR-IPC ohne Kollision bleibt, über 0,850 m Höhe hält und den Höhen-RMSE von 0,484 m auf 0,075 m senkt. Die Beobachter-Ablation unter Wind und Pendellast reduziert den Disturbance-Vector-RMSE von 0,260 m/s² auf 0,036 m/s², die Disturbance-Rate-RMS von 11,6 m/s³ auf 6,1 m/s³, die Winkelgeschwindigkeits-RMS von 0,81 rad/s auf 0,45 rad/s, das w_y-Sättigungsverhältnis von 36,0 % auf 2,1 % und die Attitude-RMS von 11,3° auf 8,6°. In der Multi-Goal-Simulation unter Störungen erreicht IPC 1/10 Missionen und 9/40 Ziele mit durchschnittlich 5 Ereignissen, DR-IPC 9/10 Missionen und 37/40 Ziele mit 0,1 Ereignissen. Im Ball-Impact-Experiment sinkt IPC auf 0,08 m, DR-IPC bleibt bei minimal 0,70 m und kehrt innerhalb von 2,30 s in das ±0,05-m-Höhenband zurück. Beim Bogen-Durchflug mit Wind und Pendellast scheitert IPC, bleibt 18,77 s außerhalb des SFC und erzielt einen Höhen-RMSE von 0,34 m; DR-IPC passiert, ist nur 2,98 s außerhalb des SFC und erzielt 0,01 m RMSE bei minimal 0,97 m Höhe. Mit dynamischem Hindernis erfüllen 4046 von 4201 Regelzyklen (96,31 %) die 10-ms-Frist; das 95. Perzentil liegt bei 9,13 ms, das Maximum bei 41,08 ms. Vier Outdoor-Routen in Wald und Fabrik werden ohne Kollision absolviert.
Die Störung wird als konstant oder langsam veränderlich angenommen und über den Prädiktionshorizont konstant gehalten; ein Störmodell oder Exosystem ist nicht implementiert. Die weiche SFC-Strafe erlaubt kurze Verletzungen der aufgeblasenen Sicherheitszone und setzt damit eine konservative Hindernisinflation voraus. Die Echtzeitfähigkeit ist weich: 3,69 % der Regelzyklen überschreiten die 10-ms-Frist, maximal 41,08 ms. Die Validierung erfolgt auf einem einzigen Quadrotor-Hardwareaufbau, der Vergleich in Experimenten vor allem gegen IPC. Der Quellcode ist laut Paper noch nicht veröffentlicht, soll aber bereitgestellt werden. Das Paper ist ein Preprint ohne dokumentierte Begutachtung.
Unternehmen aus Industrieinspektion, Logistik, Suche und Rettung sowie Agrartechnik könnten DR-IPC in 1 bis 3 Jahren in kommerzielle Drohnen-Flugstacks integrieren, sofern eine robuste LiDAR-Odometrie und ausreichende Onboard-Rechenleistung vorhanden sind. Als Preprint mit angekündigter Code-Veröffentlichung und erfolgreichen Fabrik- und Walddemonstrationen eignet sich der Ansatz zunächst als Entwicklungsbasis. Für zertifizierte Einsätze in regulierten Umgebungen sind weitere Plattformtests, Störmodellierung und harte Echtzeitgarantien nötig, was eher in mehr als 3 Jahren realistisch erscheint.
Der Volltext wird hier nicht wiedergegeben, weil die Lizenz der Studie das nicht erlaubt. Das Original steht auf arXiv.