added gps speed input to kalman filter; to be tested