Some crazy renaming broke something
trying to figure out gay integral bug
Removed gay debug, ready for acutal testing
fixed using swtich for 2 things
Merge branch 'Altitude' of https://github.com/madcowswe/Mavrx-firmware into Altitude