Change mode - STABILIZE, ALT_HOLD, LOITER and RTL
LOITER and RTL bad results
GPS OK
Merge pull request #20 from ahcorde/master

Change mode - STABILIZE, ALT_HOLD, LOITER and RTL