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.