AC_WPNav: slow target point's speed near destination
AC_WPNav: recalc leash lengths if set_horizontal_velocity is called

Resolves bug in which do-set-speed allowed reducing the speed during the
mission but not increasing it.
Slow down distance is also recalculated.
Unnecessary call to calc_wp_leash_length removed from
set_spline_origin_and_destination.