fix: route tracker logic for departure times (#33)

core/src/main/java/org/matsim/alonso_mora/algorithm/function/RouteTracker.java

@@ -197,22 +197,22 @@ public int update(List<AlonsoMoraStop> stops) {
 				AlonsoMoraStop stop = stops.get(i);
 
 				final double vehicleDepartureTime = stopArrivalTime + vehicleStopDuration;
-
-				final double stopDepartureTime;
+				double stopDepartureTime = Math.max(departureTimes.get(i - 1), vehicleDepartureTime);
+
 				if (stop.getType().equals(StopType.Pickup)) {
 					double passengerDepartureTime = Math.max(stopArrivalTime,
 							stop.getRequest().getEarliestPickupTime());
 					double passengerPickupTime = passengerDepartureTime + stopDurationProvider
 							.calcPickupDuration(dvrpVehicle(vehicle), stop.getRequest().getDrtRequest());
 					stop.setTime(passengerPickupTime);
 
-					stopDepartureTime = Math.max(passengerPickupTime, vehicleDepartureTime);
+					stopDepartureTime = Math.max(passengerPickupTime, stopDepartureTime);
 				} else if (stop.getType().equals(StopType.Dropoff)) {
 					double passengerDropoffTime = stopArrivalTime + stopDurationProvider
 							.calcDropoffDuration(dvrpVehicle(vehicle), stop.getRequest().getDrtRequest());
 					stop.setTime(passengerDropoffTime);
 
-					stopDepartureTime = Math.max(passengerDropoffTime, vehicleDepartureTime);
+					stopDepartureTime = Math.max(passengerDropoffTime, stopDepartureTime);
 				} else if (stop.getType().equals(StopType.Relocation)) {
 					stopDepartureTime = stopArrivalTime; // relocation
 				} else {