Sensor Fusion von verschiedenen Winkelpositionsgeber

[Ritchie]

Hallo Zusammen,

ich habe derzeit das Problem, das ich verschiedene Winkelpositionen, welche ich durch verschiedene Sensoren bekomme,
versuche zu einer einheitlichen Ausrichtung zu bekommen. Ich denke mal, das Kalman hier das letztendliche Ziel ist,
muss aber vorher einige andere Probleme lösen (denke ich mal).

Folgendes Problem:
Ich habe derzeit einen digitalen Gyro (ADIS16265), einen analogen Gyro (ADXR620), einen Compass CMPS (mit LSM303 für Beschleunigungsdaten) und die Ausrichtung bedingt durch die Fahrzeugbewenkung (Impulse der Räder/Ketten).

Als erstes möchte ich den analogen Gyro mit dem Beschleunigungsdaten des LSM303 vereinigen, damit hier ein stablierer Wert rauskommen. Ich Suche hier noch die Bedeutung der Accelerometerwerte des CMPS und deren Umrechnung für die Sensorfusion
mit dem analogen Gyro. Evtl. reicht hier auch ein komplimentär Filter.

http://robottini.altervista.org/kalm...mentary-filter

Danach sollen alle Messwerte (Winkelangaben) zu einer Vorhersage einer "wirklichen" Ausrichtung verwendet werden.

Hierfür musste ich doch folgende Vorbedingungen haben:

a) Alle Winkel in dem gleichen Wertebreich arbeiten (und auch Änderungen richtungsgleich sind)
Diesen teil habe ich schon, alle im Bereich von 2 PI und Änderungen sind richtungsgleich im Wert.

b) Alle Winkel müssten ungefähr den gleichen Wert haben.
Hier kommen die ersten Problem, da ich bei den Gyros noch einen Drift habe.
Auch ist der Startwinkel derzeit noch für alle Winkel nicht gleich.


Hat jemand eine Idee, wie die alle Winkel relativ gleich halte oder ist das garnicht notwendig ?

Gibt es gute Webseiten, welche die Fusionierung von mehreren Sensoren gut erklären (will mir evtl. einen befreundeten Mathematiker zur Seite holen).

Viele Grüße

R.

[Che Guevara]

Hi,

ich glaube, du hast den Sinn eines Kalman- / Komplementärfilters noch nicht verstanden

b) Alle Winkel müssten ungefähr den gleichen Wert haben.
Hier kommen die ersten Problem, da ich bei den Gyros noch einen Drift habe.
Auch ist der Startwinkel derzeit noch für alle Winkel nicht gleich.

Eine Sensordatenfusion nutzt man doch, um solche Sachen wie zb. Drift auszugleichen. Jeder Sensor hat andere Eigenschaften bzw. Vor- und Nachteile, welche durch die Fusion kombiniert werden sollen (also natürlich nur die Vorteile ).
Der Acc hat z.b. keinen Drift, dafür aber verrauschte Werte und man kann nicht zwischen Drehung & Bewegung unterschieden. Mit dem Gyro hat man sehr schnelle, "richtige" Signale mit Drift (bzw. bei Mems v.a. Quantisierungsfehler), welchen eben der absolute Bezug zum Umfeld fehlt.

Ein Komplementärfilter reicht vollkommen aus, wenn dieser richtig parametrisiert ist, weicht sein Ergebnis garnicht bis kaum vom Kalmanfilter ab (welcher immer als Wundermittel gehypt wird, was er aber nicht ist!).
Außerdem lässt sich der Komplementärfilter wesentlich schneller berechnen.

Gruß
Chris

[HaWe]

super Link zum Komplementärfilter!

dazu 3 Fragen von mir (obwohl ich nicht der TO bin... ):

1) // newAngle = angle measured with atan2 using the accelerometer
was bedeutet "measured with atan2 ...."? einfach atan2 auf die Beschleunigungswerte anwenden ??? das kann doch nicht sein ! Oder doch ?? Aber wie ??

2) // newRate = angle measured using the gyro
Gyro misst normalerweise nicht den Winkel, sondern die Rotationsgeschwindigkeit, und DIE wird als "rate" bezeichnet, sowei ich weiss.
Dann muss man doch sicherlich vorher aufinegrieren, oder? Oder wird nicht der Winkel, sondern die Rotationsgeschwindigkeit eingespeist?

3) wie schleust man jetzt noch einen zusätzlichen Kompass in die Komplementärfilter-Gleichung mit ein?

[Che Guevara]

Hi,

ja, mit dem atan2 kannst du Vorzeichenrichtig den Winkel (verrauscht) aus dem Acc ausrechnen.
Hier ist das ganze bildlich dargestellt: http://www.sensoren.info/Winkel-Beschleunigung.png

x_angleC = a* (x_angleC + newRate * dtC) + (1-a) * (newAngle);

Wenn du von dieser Formel sprichst: Da wird doch integriert.

Den Kompass fusioniert man in einem weiteren Filter mit dem GyroZ Wert, selbes Prinzip.

Gruß
Chris

[HaWe]

halt stopp - Fehler ?

[Che Guevara]

Hast du dir den Link mal genauer angesehen? Bei der Korrektur geht es nur um die Kleinwinkelnäherung, um sich den Sinus zu sparen. Ich hab das gepostet, um den Zusammenhang zwischen den trig. Funktionen und der Beschleunigung darzustellen, um klar zu machen, warum / wieso / dass der atan(2) für die Winkelberechnung geeignet ist.

Was hat deine Formel mit dem Thema zu tun?

Gruß
Chris

[HaWe]

halt stopp - irgendwas stimmt nicht:

ein Accelerometer gibt eine geradlinige Beschleunigung an, keine Winkelbeschleunigung.

Wieso also atan?

Wieso Winkel ?


doppelt über die Zeit integriert ergibt sich hingegen:
Weg = 1/2 * Beschleunigung * dt² (Weg, nicht Winkel!)