Lageregelung eines Quadrocopters

[MiniMax]

Hallo,
DAnke für deine Antwort.
Erstmal was sind die Modi?? Hover = Auf einer Stelle HH = Stabilisation?
Willas Code habe ich mir auch schonma angeschaut aber ich möchte alles von Anfang an verstehen
Was ist der/das Kp??

[ePyx]

Kp ist der Proportionalitätsfaktor also das P in PID. Ist eine einfache Skalierung/Verstärkung, daher die Multiplikation.

[MiniMax]

Ah ok jetzt habe ich folgendes gefunden:
Ich brauche Winkel und Winkelbeschleunigung wie es weiter geht KP

So um auf den Winkel zu kommen:
angle = (0.9*(angle + gyro*dt) + (0.02)*(x_acc)

0.98 und 0.02 sind die Verstärkungsfaktoren

angel ist der alte/neue Winkel, gyro der Gyro wert, x_acc die ACC werte und dt die Looptime. Aber wie bekomme ich in Bascom die dt?? Könnte man das mit nem Timer machen??
Und ist das der gesamte Filter??

Achja welche Werte holt ihr aus welchen Registern des MPU 6050 ??

[MiniMax]

Mhmmm...
Keiner ne Idee??

[Che Guevara]

Darf ich fragen, woher du die Formel hast?
0.98 und 0.02 sind die Anteile der jeweiligen Sensoren, also der resultierende Winkel setzt sich zu 98% aus dem Gyrointegral und zu 2% aus dem ACC-"Winkel" zusammen.
dt könntest du beispielsweise mittels eines Timers abfragen, wobei ich der Meinung bin, dass es auch komplett ohne dt geht, da sich deine Regelfrequenz ja nicht ständig ändert. Das ist ein Komplementärfilter, dieser ist nur dann nötig, wenn man den Hover-Mode programmiert.
Du brauchst mindestens die drei Gyro-werte, ansonsten noch ACCX und ACCY für den Hover... Falls du eine bessere Lagerregelung mit Achsentkopplung haben möchtest (also ohne Gimbal Lock), solltest du es mit Quaternionen probieren... Da hab ich aber absolut keine Ahnung und auch keine gute Quelle, wo man sich als Laie informieren kann.. Wenn jemand was findet, immer her damit

Gruß
Chris

[MiniMax]

mhmmm mit den Anteilen so weit war ich auch
Das ist aus nem pdf im I-net
Ich habe gehört/gelesen, dass der Komplementärfilter eine einfache Form des Kalman Filters ist aber dennoch gute Werte liefert ?!?
Das ohne dt verstehe ich nicht... Der Gyro gibt doch °/s an und das muss ich auf meine Zeit zwischen den Mesungen bringen??? Oder nicht??

Ist das denn der Komplette Filter?? Gehen dann aus dem der Wert und der ACC in die Regelstrecke??