AP_L1_Control & commands_logic

Added functionality so that the turn to the next waypoint starts when the vehicle is within the L1 length of the next waypoint.
AP_AHRS

Changed default complementary filter coefficient from 0.05 to 0.1 based on flight test results conducted using a UBlox LEA-6