Könnte es ein, dass im Teil „Unterschied Kalman Filter und Extended Kalman Filter“ Predict und Update vertauscht wurden?
Die Messung kommt sollte im Update Schritt einbezogen werden. Im Predict Schritt wird – in diesem Beispiel – nur Geschwindigkeit*Zeit auf die Position addiert und das tut ja die Funktion g_A (bzw. im KF die Matrix A).
↧
Von: Niklas
↧