[QuadADK] Tests with manual take off and landing. Improve navigation and
use sensors/camera at waypoints. Add GPS failsafe (not used yet)