Please see my repro mission. This simple scheme of waypoints works perfectly on all land vehicles, however, the submarine does not understand this.
Submarines must disembark command(Unload-waypoint) and sail away, but AI-driver of this submarine ignores waypoint.

{F26599}