Copter: AC_AttitudeControl clean up stabilize