Kalman Filter of an unicycle model