Zum Inhalt

Cookie-Einstellungen

Sie entscheiden je Kategorie, welche Dienste wir nutzen dürfen; vorausgewählt ist nichts. Ihre Wahl gilt für alle Seiten unter fh‑wedel.de, wird 12 Monate in einem Cookie gespeichert und lässt sich jederzeit im Footer unter „Cookie-Einstellungen“ ändern oder widerrufen. Datenschutz

Notwendig

Immer aktiv

Speichert Ihre Wahl, damit die Einwilligung funktioniert. Immer aktiv.

  • EinwilligungsverwaltungFachhochschule Wedel gGmbH
    Anbieter
    Fachhochschule Wedel gGmbH, Feldstraße 143, 22880 Wedel
    Zweck
    Speichert Ihre Entscheidung über Cookies und Dienste, damit wir Sie nicht bei jedem Aufruf erneut fragen.
    Cookies
    • fhw_einwilligung12 Monate
    • fhw_widerspruch12 Monate
    Drittland
    keins (EU)

Statistik

Wir messen, wie viele Menschen unsere Seiten besuchen und welche Beiträge sie lesen, um das Angebot zu verbessern.

  • Google Tag ManagerGoogle Ireland Limited
    Anbieter
    Google Ireland Limited, Gordon House, Barrow Street, Dublin 4, Irland
    Zweck
    Lädt die Dienste der Kategorien, in die Sie eingewilligt haben.
    Cookies
    keine eigenen
    Drittland
    USA (Data Privacy Framework)
  • Google Analytics 4Google Ireland Limited
    Anbieter
    Google Ireland Limited, Gordon House, Barrow Street, Dublin 4, Irland
    Zweck
    Misst, wie unsere Seiten genutzt werden, etwa welche Seiten aufgerufen werden und woher die Besuche kommen.
    Cookies
    • _ga2 Jahre
    • _ga_*2 Jahre
    Drittland
    USA (Data Privacy Framework)
  • MatomoFachhochschule Wedel gGmbH (eigener Server)
    Anbieter
    Fachhochschule Wedel gGmbH (eigener Server), Feldstraße 143, 22880 Wedel
    Zweck
    Misst auf unserem eigenen Server, welche Seiten und Beiträge aufgerufen und gelesen werden und woher die Besuche kommen.
    Cookies
    • _pk_id*13 Monate
    • _pk_ses*30 Minuten
    • _pk_ref*6 Monate
    Drittland
    keins (EU)

Marketing

Wir zeigen Werbung für die FH Wedel bei Google, Facebook, Instagram und TikTok (auch Menschen, die unsere Seiten besucht haben) und messen, ob sie wirkt. Dabei gelangen Daten in die USA und nach China.

  • Google Tag ManagerGoogle Ireland Limited
    Anbieter
    Google Ireland Limited, Gordon House, Barrow Street, Dublin 4, Irland
    Zweck
    Lädt die Dienste der Kategorien, in die Sie eingewilligt haben.
    Cookies
    keine eigenen
    Drittland
    USA (Data Privacy Framework)
  • Google AdsGoogle Ireland Limited
    Anbieter
    Google Ireland Limited, Gordon House, Barrow Street, Dublin 4, Irland
    Zweck
    Misst, ob Besuche auf unsere Anzeigen zurückgehen, und zeigt unsere Anzeigen Besucherinnen und Besuchern erneut (Remarketing).
    Cookies
    • _gcl_*3 Monate
    Drittland
    USA (Data Privacy Framework)
  • Meta-PixelMeta Platforms Ireland Limited
    Anbieter
    Meta Platforms Ireland Limited, Merrion Road, Dublin 4, D04 X2K5, Irland
    Zweck
    Misst den Erfolg unserer Anzeigen auf Facebook und Instagram und zeigt sie passenden Zielgruppen.
    Cookies
    • _fbp3 Monate
    • _fbc3 Monate
    Drittland
    USA (Data Privacy Framework)
  • TikTok-PixelTikTok Technology Limited
    Anbieter
    TikTok Technology Limited, 10 Earlsfort Terrace, Dublin, D02 T380, Irland
    Zweck
    Misst den Erfolg unserer Anzeigen auf TikTok und zeigt sie passenden Zielgruppen.
    Cookies
    • _ttp13 Monate
    • _tt_enable_cookie13 Monate
    • ttcsid*siehe Anbieter
    Drittland
    Drittländer einschließlich China (Standardvertragsklauseln)

Externe Medien

Wir zeigen eingebettete Videos und andere Inhalte fremder Anbieter direkt auf unseren Seiten; dabei erhält der Anbieter Daten wie Ihre IP-Adresse.

  • YouTubeGoogle Ireland Limited
    Anbieter
    Google Ireland Limited, Gordon House, Barrow Street, Dublin 4, Irland
    Zweck
    Spielt eingebettete Videos von YouTube ab, nachdem Sie ein Video geladen haben.
    Cookies
    keine eigenen
    Drittland
    USA (Data Privacy Framework)
Alle Artikel

Thesis

Wie Drohnen ihre Orientierung bestimmen: Entwicklung und Vergleich moderner Komplementärfilter

Ohne Magnetometer driftet die Orientierungsschätzung eines Drohnen-Gimbals. Eine Bachelorarbeit vergleicht drei Komplementärfilter und entwickelt den besten so weiter, dass der Drift um die Yaw-Achse nahezu verschwindet.

  • Veröffentlicht am
  • Verfasst von Lars Mannshardt, B. Sc. Technische Informatik
  • Betreut von Prof. Sergei Sawitzki
  • Teilen

Zusammenfassung

Im Rahmen der Bachelorarbeit „Lineare und nichtlineare Komplementärfilter zur Orientierungsschätzung eines UAV-Gimbal-Systems“ wurden drei mathematische Verfahren zur Berechnung der Orientierung eines Körpers durch die Fusion unterschiedlicher Sensordaten untersucht und für den Einsatz zur Orientierungsschätzung eines Drohnen-Gimbals miteinander verglichen. Der Filter mit der höchsten Genauigkeit und dem geringsten Driftverhalten wurde für die Anwendung weiterentwickelt und anschließend mit den bestehenden Lösungen verglichen. Dabei konnte gegenüber den ursprünglichen Verfahren eine stabilere und genauere Orientierungsschätzung erzielt werden.

Einführung

Drohnen sind heutzutage allgegenwärtig – ihre Einsatzgebiete reichen von Paketlieferungen und der Inspektion technischer Anlagen bis hin zu militärischen Aufklärungs- und Wirkeinsätzen. Dabei kommen in fast allen Fällen Drohnen mit Kamerasystemen zur Anwendung, für die eine präzise Zielerfassung oder Bildstabilisierung notwendig ist, um Vibrationen der Motoren, Flugbewegungen und Windstöße zu kompensieren.

Um eine solche Stabilisierung in der Praxis umzusetzen, werden die Kamerasysteme nicht direkt an das Gehäuse der Drohne montiert, sondern auf einem Gimbal befestigt, der wiederum mit der Drohne verbunden ist. Ein Gimbal ist eine mehrachsige bewegliche Plattform zur Stabilisierung von Kameras oder anderen Nutzlasten. Durch gezielte Rotationsbewegungen, ausgeführt von an den Achsen der Plattform angebrachten Motoren, kann ein Gimbal Bewegungen der Drohne ausgleichen und somit ein stabiles Kamerabild weitestgehend unabhängig von der Bewegung der Drohne selbst liefern. Der für die experimentellen Untersuchungen dieser Arbeit verwendete Gimbal ist in Abbildung 1 dargestellt.

Gimbal an einem Dreibeingestell über einer Schneidematte, mit Sensorplatine, roten Koordinatenachsen und Mikrocontroller-Board im Vordergrund.
Abb. 1: Experimenteller Aufbau des Gimbal-Systems. Auf dem zylinderförmigen Körper ist die inertiale Messeinheit montiert.

Um den Gimbal geeignet stabilisieren zu können, ist eine Information über die aktuelle Orientierung der Plattform notwendig. Zur Orientierungsschätzung kommen sogenannte AHRS-Algorithmen (Attitude and Heading Reference System) zum Einsatz, welche die Daten mehrerer unterschiedlicher, auf dem Gimbal angebrachter Sensoren auswerten und fusionieren, um eine möglichst genaue und stabile Schätzung der Orientierung zu berechnen. Neben dem weit verbreiteten Kalman-Filter kommen auch weniger rechenintensive AHRS-Algorithmen wie die Komplementärfilter zur Anwendung, von denen drei Verfahren aufgrund ihrer vergleichsweise geringen Laufzeit für eingebettete Systeme besonders attraktiv sind und als Hauptbestandteil dieser Arbeit untersucht werden.

Eine wesentliche Herausforderung stellt allerdings der Verzicht auf Magnetometer-Sensorik dar. Magnetometer messen das Erdmagnetfeld und leisten einen wesentlichen Beitrag zur Kompensierung des Driftverhaltens der AHRS-Algorithmen.

Aufgrund der von den Elektromotoren des Gimbals verursachten Magnetfelder kann ein Magnetometer in der Nähe der Plattform keine zuverlässigen Messwerte liefern und wird daher nicht verwendet. Als Sensordatenquelle steht dementsprechend nur die auf dem Gimbal befestigte inertiale Messeinheit zur Verfügung, die Beschleunigungssensoren und Gyroskope für alle drei Achsen enthält.

Untersuchung

In dieser Arbeit wurden drei verschiedene Komplementärfilter auf einem eingebetteten System implementiert und hinsichtlich der Genauigkeit ihrer Orientierungsschätzung in dynamischen und statischen Umgebungen, der Langzeitstabilität und der Echtzeitfähigkeit ihrer Implementierung untersucht.

Komplementärfilter kombinieren Messdaten von Beschleunigungssensoren und Gyroskopen, um die Orientierung eines Körpers möglichst genau zu bestimmen. Ihr Ziel ist es, die Schwächen der jeweiligen Sensoren durch die Fusion der Sensordaten auszugleichen. Abbildung 2 zeigt die Fusion von Beschleunigungs- und Gyroskopdaten eines Komplementärfilters zur Orientierungsschätzung. Für diese Untersuchung wurden der lineare Komplementärfilter sowie die beiden nichtlinearen Mahony- und Madgwick-Filter untersucht. Alle drei Algorithmen wurden in der Programmiersprache C implementiert und auf einem Mikrocontroller hinsichtlich der bereits genannten Kriterien untersucht und verglichen.

Als Sensordaten wurden neben den Messwerten einer realen inertialen Messeinheit vor allem künstlich generierte Sensordaten für Beschleunigungen und Winkelgeschwindigkeiten verwendet. Dafür wurde die inertiale Messeinheit in MATLAB simuliert und auf Basis einer vorgegebenen Referenztrajektorie die notwendigen Sensordaten erzeugt. Diese wurden anschließend in den Flash-Speicher des Mikrocontrollers geladen und als reale Sensordaten interpretiert. Auf diese Weise wird sichergestellt, dass die zu untersuchenden Fehler in der Orientierungsschätzung der Filter nicht auf Abweichungen der Referenztrajektorie, sondern auf das jeweilige Filterverhalten zurückgeführt werden können. Abbildung 3 zeigt den Vorgang zur Generierung künstlicher IMU-Sensordaten, wie sie im Rahmen dieser Arbeit erzeugt wurden.

Sowohl in Bewegung als auch in Ruhelage erzielten Mahony- und Madgwick-Filter deutlich genauere Ergebnisse in der Orientierungsschätzung als der lineare Komplementärfilter. Durch das Fehlen eines Magnetometers kann der Drift um die Yaw-Achse allerdings bei keinem der Algorithmen ausreichend kompensiert werden, weshalb die Fehler des Winkels ψ deutlich höher sind (vgl. Tabelle 1). Um eine für die Anwendung notwendige genauere Orientierungsschätzung zu erreichen, wurde der Madgwick-Filter erweitert.

Weiterentwicklung

Der Madgwick-Filter erzielt die höchste Genauigkeit in der Orientierungsschätzung bei Bewegung und wurde um eine langzeitstabile Encoderreferenz ergänzt, welche den Drift um die Yaw-Achse korrigiert. Die Motoren des Gimbals besitzen jeweils einen Encoder, welcher den Winkel der Motorstellung angibt. Durch diesen Winkel in Kombination mit einer weiteren in dem Gehäuse der Drohne montierten inertialen Messeinheit lässt sich die Orientierungsschätzung des Filters korrigieren. Darüber hinaus wurde der Madgwick-Filter um eine Gyroskop-Driftkompensation erweitert. Die experimentellen Ergebnisse in Bewegung mit künstlichen Sensordaten sind in Tabelle 1 dargestellt.

Tabelle 1: Mittelwerte des RMSE zwischen Referenztrajektorie und geschätzter Orientierung für die Eulerwinkel ϕ, θ und ψ unter dem Einfluss von Bewegung.

FilterRMSE[ϕ]RMSE[θ]RMSE[ψ]
Linearer KF0.2227°0.2277°0.2865°
Mahony0.1139°0.1190°0.2861°
Madgwick0.1011°0.1119°0.2863°
ext. Madgwick0.1183°0.1073°0.0189°

Der RMSE (Root Mean Square Error) ist ein Fehlermaß, das die durchschnittliche Größe der Fehlerwerte beschreibt. Je geringer der RMSE, umso kleiner ist also auch der Fehler in der Orientierungsschätzung. In der Tabelle erkennt man, dass der Mittelwert des RMSE für jeweils 6 Messreihen beim Madgwick-Filter für eine Rotation um die Roll-Achse (ϕ) am geringsten ist. Für die Achsen Pitch (θ) und Yaw (ψ) liefert der erweiterte Madgwick-Filter den geringsten Fehler und damit die genaueste Orientierungsschätzung.

Fazit

Durch die Untersuchungen dieser Arbeit hat sich herausgestellt, dass der Madgwick-Filter die höchste Genauigkeit in der Orientierungsschätzung bei Bewegung der inertialen Messeinheit erreicht, während der Mahony-Filter die höchste Stabilität in Ruhelage liefert. Durch die Erweiterung des Madgwick-Filters wurde die statische Stabilität deutlich verbessert und der Drift um die Yaw-Achse nahezu vollständig kompensiert. Somit erreicht der erweiterte Madgwick-Filter eine insgesamt genauere Orientierungsschätzung und erweist sich von allen untersuchten Filtern als am besten für die Anwendung in einem Gimbal-System geeignet.