Testing Kalman Filter for GPS data