Merged in the most recent changed from the PX4/Firmware repo
Added ways to calculate the gains, M and C in my h infinity class
Merge remote-tracking branch 'origin/master'