testing gps and servo in threads