Mission: start next nav cmd immediately after prev completes
AC_WPNav: resolve twitch when passing spline waypoints

The target positions target velocity was being reset to zero as we
passed through a spline waypoint.