Made huge changes, but didn't finish
Merge branch 'master' of http://github.com/PixHawk674/Firmware