Change the ATT/Vertical loops PID values and the AP Mode.