Fixed all the PID values. Roll and pitch angle gain scheduling left.