cleaned uup UAV code
added 4 channel support and trimming