Sigma-Punkt Kalman-Filter mit Ungleichungsnebenbedingungen
Autori
Viac o knihe
In dieser Arbeit wird ein Kalman-Filter vorgestellt, das in seine Schätzung physikalische oder durch die Planung vorgegebene Nebenbedingungen einbezieht. Dabei wird das Augenmerk explizit auf die Nichtlinearitäten in den Gleichungen und die stochastischen Eigenschaften der Zufallsvariablen gerichtet. Zugrunde liegen die gewonnenen Erkenntnisse aus dem Sigma-Punkt (SP) Kalman-Filter, bei dem zur Linearisierung die deterministisch gewählten SP durch nichtlineare Gleichungen transformiert werden. Es werden zwei unterschiedliche Ansätze zur Berücksichtigung der Nebenbedingungen vorgestellt. Der erste Ansatz basiert auf der Verschiebung der SP, dem zweiten liegt ein Optimierungsproblem zugrunde. Um das Optimierungsproblem zu lösen, bedient man sich der aktuellen Methoden aus der Mathematik. In Folge dessen werden zwei Filterverfahren entwickelt: Das Innere-Punkte Kalman-Filter, das ausgehend von einem Startpunkt eine Folge von Inneren Punkten generiert, und das Sequential-Quadratic-Programming Kalman-Filter, bei dem in jedem Iterationsschritt ein quadratisches Optimierungsproblem gelöst wird. Die Filterverfahren werden anhand eines praktischen Beispiels, der inertialen Navigation, getestet. Dabei wird ein mobiler Roboter mit einer kostengünstigen IMU (Inertial Measurement Unit) ausgestattet, um dessen Bewegung in einer bekannten, beschränkten Umgebung zu erfassen. Es wird gezeigt, dass die Schätzung der Position unter Berücksichtigung der Nebenbedingungen stets ein sinnvolles und genaueres Ergebnis liefert.