Merge pull request #975 from PX4/fwattrobustify

Make the fw att controller more robust against infinite input
Merge remote-tracking branch 'upstream/master' into mtecs