Refactor controls loops at PI_rate, PI_attitude_rate.
Comment out new PI loops.