Hallo Rainer,
zur GPS Berechnung - Ich würde den Algorthmus etwa so konzipieren:
1. Nächste GPS-Messung durchführen (Lon/Lat ermitteln).
2. Überprüfen der Satelliten-Konstellation am Himmel (HDOP-Wert der Messung): Ist der HDOP-Wert "schlecht" wird die letzte Messung verworfen (Fortsetzung mit Schritt 1).
3. GPS-Messung (Lon/Lat) umrechnen in eigenes Meter-Koordinatensystem (s. Code im Testprogramm weiter oben im Anhang), welches seinen Ursprung (0,0) z.B. bei der Ladestation hat.
4. Solange noch keine 10 Meßwerte vorhanden sind, mit 1. fortfahren.
5.
Mittelwert für alle Meßwerte berechnen.
6. Dann z.B. die
Varianz über alle Meßwerte berechnen, welche ein Maß dafür ist wie stark die Werte vom Mittelwert abweichen. Ist die Varianz zu groß, würde ich (nach FIFO-Prinzip) die früheste Messung verwerfen (Fortsetzung mit Schritt 1)
7. Der so errechnete Mittelwert ist dann eine Schätzung der Position.
Zum Kalman-Filter (für Kompaß): Meinst Du die Rohwerte von Kompaß/Gyro/Beschl.Sensor um diese damit zu filtern (bzw. zu fusionieren)? (dafür gibt es bestimmt einige Beispiele im Netz...) - Oder möchtest Du die vom Ardumower-Kompaß-Code ermittelten Kompaß-Werte nochmal nachträglich filtern?
Ich selber werde mich wohl mit Kalman-Filter demnächst auseinandersetzen und könnte dann mehr dazu sagen.
UPDATE: Kalman-Filter hat nun ein
eigenes Thema bekommen.
Gruss,
Alexander
Attachment:
https://forum.ardumower.de/data/media/kunena/attachments/905/kalman1d_2014-01-18.zip/