Updated for new inner-loop (attitude rate) controller.