in-progress GPS waypoint code, lots of stuff broken
Merge branch 'Auto' of http://github.com/madcowswe/Mavrx-firmware into Auto