TradHeli:  Change to the way the swash controller is done.  Split into two functions.  Cleaner.