:wArc radius and stop distance formula is good now.
Added smooth function and new thresholds
Updated thresholds
Navigation update