Add GPS speed and error data to telemetry and aoview