If you haven’t read this yet http://discuss.ardupilot.org/t/technique-to-expand-roll-and-pitch-rate-pid-gains-without-instabilities/12982