Fix somethings in the Kalman caller function