WARNING: Change to APM_Config for TradHeli Compile!
TradHeli: Rate PID Improvement. Limit Integrator wind-up when PID output is saturated. Also a little bit of general clean-up for readability.