Hallo,
um meine Gyros zu filtern (bzw. das Integral davon) bin ich auf der Suche nach einer Software Implementation eines Hochpasses! Jedoch habe ich bis jetzt noch nichts brauchbares gefunden Mir würde auch schon ein (leicht verständlicher) C-Code oder Pseudocode genügen! In einem anderen Thread ( https://www.roboternetz.de/community...g-der-Bauteile ) hat Besserwessi folgendes geschrieben:
Code:
Ein typischer Hochpassfilter wäre so:
drift = 0.999 * drift + ADC
adc = adc - drift
Allerdings weiß ich nicht, wie ich meine Werte da einsetzen soll, bzw. Anfangs dachte ich, ich muss einfach nur adc durch integral ersetzen und die Var. drift bleibt gleich....
Code:
Drift = Drift * 999
Drift = Drift / 1000
Drift = Drift + _integral
_integral = _integral - Drift
Jedoch ist dem nicht so oder ich bin einfach zu blöd dafür!
Integral ist bei mir der integrierte Wert des Roll-Gyros (WM+).
Kann mir jemand bei meinem Problem helfen?
Gruß
Chris
Lesezeichen