L1_control

Previous files updated to Matlab/Simulink 2012a
Prototype L1_Control model with fallback mode added.

Fallback mode provides the facility to switch to flying directly to the next waypoint if the closing distance to the next waypoint becomes negative