make sure vehicle switch is feasible

Author: oblonski

jsprit-core/src/main/java/com/graphhopper/jsprit/core/algorithm/state/UpdateVehicleDependentPracticalTimeWindows.java

@@ -26,8 +26,8 @@
 import com.graphhopper.jsprit.core.problem.solution.route.activity.TourActivity;
 import com.graphhopper.jsprit.core.problem.vehicle.Vehicle;
 
-import java.util.Arrays;
 import java.util.Collection;
+import java.util.Collections;
 import java.util.Iterator;
 
 public class UpdateVehicleDependentPracticalTimeWindows implements RouteVisitor, StateUpdater {
@@ -40,6 +40,12 @@ public void visit(VehicleRoute route) {
             visit(revIterator.next());
         }
         finish();
+
+        Iterator<TourActivity> tourIterator = route.getTourActivities().iterator();
+        while (tourIterator.hasNext()) {
+            visitForward(tourIterator.next());
+        }
+        finishForward();
     }
 
     public interface VehiclesToUpdate {
@@ -48,7 +54,7 @@ public interface VehiclesToUpdate {
 
     }
 
-    private VehiclesToUpdate vehiclesToUpdate = route -> Arrays.asList(route.getVehicle());
+    private VehiclesToUpdate vehiclesToUpdate = route -> Collections.singletonList(route.getVehicle());
 
     private final StateManager stateManager;
 
@@ -58,9 +64,13 @@ public interface VehiclesToUpdate {
 
     private VehicleRoute route;
 
-    private double[] latest_arrTimes_at_prevAct;
+    private final double[] vehicleDependentLatestArrTimesPrevAct;
+
+    private final double[] vehicleDependentEarliestDepartureTimesPrevAct;
+
+    private final Location[] vehicleDependentLocationPrevActBackward;
 
-    private Location[] location_of_prevAct;
+    private final Location[] vehicleDependentLocationPrevActForward;
 
     private Collection<Vehicle> vehicles;
 
@@ -69,47 +79,74 @@ public UpdateVehicleDependentPracticalTimeWindows(StateManager stateManager, Veh
         this.stateManager = stateManager;
         this.transportCosts = tpCosts;
         this.activityCosts = activityCosts;
-        latest_arrTimes_at_prevAct = new double[stateManager.getMaxIndexOfVehicleTypeIdentifiers() + 1];
-        location_of_prevAct = new Location[stateManager.getMaxIndexOfVehicleTypeIdentifiers() + 1];
+        vehicleDependentLatestArrTimesPrevAct = new double[stateManager.getMaxIndexOfVehicleTypeIdentifiers() + 1];
+        vehicleDependentEarliestDepartureTimesPrevAct = new double[stateManager.getMaxIndexOfVehicleTypeIdentifiers() + 1];
+        vehicleDependentLocationPrevActBackward = new Location[stateManager.getMaxIndexOfVehicleTypeIdentifiers() + 1];
+        vehicleDependentLocationPrevActForward = new Location[stateManager.getMaxIndexOfVehicleTypeIdentifiers() + 1];
     }
 
     public void setVehiclesToUpdate(VehiclesToUpdate vehiclesToUpdate) {
         this.vehiclesToUpdate = vehiclesToUpdate;
     }
 
 
-    public void begin(VehicleRoute route) {
+    void begin(VehicleRoute route) {
         this.route = route;
         vehicles = vehiclesToUpdate.get(route);
         for (Vehicle vehicle : vehicles) {
-            latest_arrTimes_at_prevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = vehicle.getLatestArrival();
+            vehicleDependentLatestArrTimesPrevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = vehicle.getLatestArrival();
+            vehicleDependentEarliestDepartureTimesPrevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = vehicle.getEarliestDeparture();
             Location location = vehicle.getEndLocation();
             if(!vehicle.isReturnToDepot()){
                 location = route.getEnd().getLocation();
             }
-            location_of_prevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = location;
+            vehicleDependentLocationPrevActBackward[vehicle.getVehicleTypeIdentifier().getIndex()] = location;
+            Location startLocation = vehicle.getStartLocation();
+            if (vehicle.getStartLocation() == null) {
+                startLocation = route.getStart().getLocation();
+            }
+            vehicleDependentLocationPrevActForward[vehicle.getVehicleTypeIdentifier().getIndex()] = startLocation;
         }
     }
 
 
-    public void visit(TourActivity activity) {
+    void visit(TourActivity activity) {
         for (Vehicle vehicle : vehicles) {
-            double latestArrTimeAtPrevAct = latest_arrTimes_at_prevAct[vehicle.getVehicleTypeIdentifier().getIndex()];
-            Location prevLocation = location_of_prevAct[vehicle.getVehicleTypeIdentifier().getIndex()];
+            double latestArrTimeAtPrevAct = vehicleDependentLatestArrTimesPrevAct[vehicle.getVehicleTypeIdentifier().getIndex()];
+            Location prevLocation = vehicleDependentLocationPrevActBackward[vehicle.getVehicleTypeIdentifier().getIndex()];
             double potentialLatestArrivalTimeAtCurrAct = latestArrTimeAtPrevAct - transportCosts.getBackwardTransportTime(activity.getLocation(), prevLocation,
-                latestArrTimeAtPrevAct, route.getDriver(), vehicle) - activityCosts.getActivityDuration(activity, latestArrTimeAtPrevAct, route.getDriver(), route.getVehicle());
+                    latestArrTimeAtPrevAct, route.getDriver(), vehicle) - activityCosts.getActivityDuration(activity, latestArrTimeAtPrevAct, route.getDriver(), vehicle);
             double latestArrivalTime = Math.min(activity.getTheoreticalLatestOperationStartTime(), potentialLatestArrivalTimeAtCurrAct);
             if (latestArrivalTime < activity.getTheoreticalEarliestOperationStartTime()) {
                 stateManager.putTypedInternalRouteState(route, vehicle, InternalStates.SWITCH_NOT_FEASIBLE, true);
             }
             stateManager.putInternalTypedActivityState(activity, vehicle, InternalStates.LATEST_OPERATION_START_TIME, latestArrivalTime);
-            latest_arrTimes_at_prevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = latestArrivalTime;
-            location_of_prevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = activity.getLocation();
+            vehicleDependentLatestArrTimesPrevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = latestArrivalTime;
+            vehicleDependentLocationPrevActBackward[vehicle.getVehicleTypeIdentifier().getIndex()] = activity.getLocation();
+
+        }
+    }
+
+    void visitForward(TourActivity activity) {
+        for (Vehicle vehicle : vehicles) {
+            double earliestDepartureAtPrevAct = vehicleDependentEarliestDepartureTimesPrevAct[vehicle.getVehicleTypeIdentifier().getIndex()];
+            Location earliestLocation = vehicleDependentLocationPrevActForward[vehicle.getVehicleTypeIdentifier().getIndex()];
+            double potentialEarliestArrivalTimeAtCurrAct = earliestDepartureAtPrevAct + transportCosts.getTransportTime(earliestLocation, activity.getLocation(), earliestDepartureAtPrevAct, route.getDriver(), vehicle);
+            if (potentialEarliestArrivalTimeAtCurrAct > activity.getTheoreticalLatestOperationStartTime()) {
+                stateManager.putTypedInternalRouteState(route, vehicle, InternalStates.SWITCH_NOT_FEASIBLE, true);
+            }
+            double earliestStart = Math.max(potentialEarliestArrivalTimeAtCurrAct, activity.getTheoreticalEarliestOperationStartTime());
+            double earliestDeparture = earliestStart + activityCosts.getActivityDuration(activity, earliestStart, route.getDriver(), vehicle);
+            vehicleDependentEarliestDepartureTimesPrevAct[vehicle.getVehicleTypeIdentifier().getIndex()] = earliestDeparture;
+            vehicleDependentLocationPrevActForward[vehicle.getVehicleTypeIdentifier().getIndex()] = activity.getLocation();
         }
     }
 
 
-    public void finish() {
+    void finish() {
+    }
+
+    void finishForward() {
     }
 
 }