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
Lesezeichen