Kalman filter modifications; UDP receive changes