AD_WPNav: added WPNAV_STPG_LSH user definable parameter for adjusting switching-stopping strength 

AD_WPNav: added WPNAV_STPG_LSH user definable parameter for adjusting switching-stopping strength and smoothness