multirotor_att_control: cleanup, some refactoring
Merge pull request #444 from PX4/multirotor_att_control_fix

multirotor_att_control: cleanup, some refactoring