Update AP_L1_Control.cpp

Start of fix for 'indecision' shown when capturing a waypoint directly behind the aircaft.
To-Do : apply hysteresis to Nu angle calculated in ln 153