AC_WPNav: Leonard's 3d leash calculator
AC_WPNav: stop track_desired from moving backwards