bye bye
Added init to position
reset destination whenever we switch modes for position hold consistancy
fixed wp reporting issue
X and Y reversed no longer
Added reached destination check
initing home regardless of GPS, fast gains were not disabled properly.
multi-mode is just 2 options right now.
made MM just two options, remove takeoff command
Slowed default WP speed and shrank radius to hit
added debugging for AP
fixed issue where home is set to 0 when no lock
removed old code, switched X and Y
removed old (int) types from print statement
only disarm if we are armed already