@Before
  public void doBefore() {

    routingCosts = CostFactory.createManhattanCosts();
    activityCosts = new WaitingTimeCosts();

    VehicleRoutingProblem vrpMock = mock(VehicleRoutingProblem.class);
    when(vrpMock.getFleetSize()).thenReturn(VehicleRoutingProblem.FleetSize.FINITE);
    stateManager = new StateManager(vrpMock);

    reverseActivityVisitor = new ReverseRouteActivityVisitor();
    reverseActivityVisitor.addActivityVisitor(
        new UpdatePracticalTimeWindows(stateManager, routingCosts, activityCosts));

    Pickup pickup =
        (Pickup)
            Pickup.Builder.newInstance("pick")
                .setLocation(Location.newInstance("0,20"))
                .setTimeWindow(TimeWindow.newInstance(0, 30))
                .build();
    Delivery delivery =
        (Delivery)
            Delivery.Builder.newInstance("del")
                .setLocation(Location.newInstance("20,20"))
                .setTimeWindow(TimeWindow.newInstance(10, 40))
                .build();
    Pickup pickup2 =
        (Pickup)
            Pickup.Builder.newInstance("pick2")
                .setLocation(Location.newInstance("20,0"))
                .setTimeWindow(TimeWindow.newInstance(20, 50))
                .build();

    Vehicle vehicle =
        VehicleImpl.Builder.newInstance("v")
            .setStartLocation(Location.newInstance("0,0"))
            .setType(mock(VehicleType.class))
            .build();

    VehicleRoutingProblem.Builder vrpBuilder = VehicleRoutingProblem.Builder.newInstance();
    final VehicleRoutingProblem vrp =
        vrpBuilder.addJob(pickup).addJob(pickup2).addJob(delivery).build();

    route =
        VehicleRoute.Builder.newInstance(vehicle, mock(Driver.class))
            .setJobActivityFactory(
                new JobActivityFactory() {
                  @Override
                  public List<AbstractActivity> createActivities(Job job) {
                    return vrp.copyAndGetActivities(job);
                  }
                })
            .addService(pickup)
            .addService(delivery)
            .addService(pickup2)
            .build();

    reverseActivityVisitor.visit(route);
  }
  @Test(expected = UnsupportedOperationException.class)
  public void
      whenHavingShipmentsAndServicesInOneProblem_andInsertionShouldBeMadeOnRouteLevel_throwException() {
    /* get a vehicle type-builder and build a type with the typeId "vehicleType" and a capacity of 2
     */
    VehicleTypeImpl.Builder vehicleTypeBuilder =
        VehicleTypeImpl.Builder.newInstance("vehicleType").addCapacityDimension(0, 2);
    VehicleType vehicleType = vehicleTypeBuilder.build();

    /*
     * get a vehicle-builder and build a vehicle located at (10,10) with type "vehicleType"
     */
    VehicleImpl.Builder vehicleBuilder = VehicleImpl.Builder.newInstance("vehicle");
    vehicleBuilder.setStartLocation(Location.newInstance(10, 10));
    vehicleBuilder.setType(vehicleType);
    VehicleImpl vehicle = vehicleBuilder.build();

    /*
     * build shipments at the required locations, each with a capacity-demand of 1.
     * 4 shipments
     * 1: (5,7)->(6,9)
     * 2: (5,13)->(6,11)
     * 3: (15,7)->(14,9)
     * 4: (15,13)->(14,11)
     */

    Shipment shipment1 =
        Shipment.Builder.newInstance("1")
            .addSizeDimension(0, 1)
            .setPickupLocation(TestUtils.loc(Coordinate.newInstance(5, 7)))
            .setDeliveryLocation(TestUtils.loc(Coordinate.newInstance(6, 9)))
            .build();
    Shipment shipment2 =
        Shipment.Builder.newInstance("2")
            .addSizeDimension(0, 1)
            .setPickupLocation(TestUtils.loc(Coordinate.newInstance(5, 13)))
            .setDeliveryLocation(TestUtils.loc(Coordinate.newInstance(6, 11)))
            .build();

    Shipment shipment3 =
        Shipment.Builder.newInstance("3")
            .addSizeDimension(0, 1)
            .setPickupLocation(TestUtils.loc(Coordinate.newInstance(15, 7)))
            .setDeliveryLocation(TestUtils.loc(Coordinate.newInstance(14, 9)))
            .build();
    Shipment shipment4 =
        Shipment.Builder.newInstance("4")
            .addSizeDimension(0, 1)
            .setPickupLocation(TestUtils.loc(Coordinate.newInstance(15, 13)))
            .setDeliveryLocation(TestUtils.loc(Coordinate.newInstance(14, 11)))
            .build();

    /*
     * build deliveries, (implicitly picked up in the depot)
     * 1: (4,8)
     * 2: (4,12)
     * 3: (16,8)
     * 4: (16,12)
     */
    Delivery delivery1 =
        (Delivery)
            Delivery.Builder.newInstance("5")
                .addSizeDimension(0, 1)
                .setLocation(TestUtils.loc(Coordinate.newInstance(4, 8)))
                .build();
    Delivery delivery2 =
        (Delivery)
            Delivery.Builder.newInstance("6")
                .addSizeDimension(0, 1)
                .setLocation(TestUtils.loc(Coordinate.newInstance(4, 12)))
                .build();
    Delivery delivery3 =
        (Delivery)
            Delivery.Builder.newInstance("7")
                .addSizeDimension(0, 1)
                .setLocation(TestUtils.loc(Coordinate.newInstance(16, 8)))
                .build();
    Delivery delivery4 =
        (Delivery)
            Delivery.Builder.newInstance("8")
                .addSizeDimension(0, 1)
                .setLocation(TestUtils.loc(Coordinate.newInstance(16, 12)))
                .build();

    VehicleRoutingProblem.Builder vrpBuilder = VehicleRoutingProblem.Builder.newInstance();
    vrpBuilder.addVehicle(vehicle);
    vrpBuilder
        .addJob(shipment1)
        .addJob(shipment2)
        .addJob(shipment3)
        .addJob(shipment4)
        .addJob(delivery1)
        .addJob(delivery2)
        .addJob(delivery3)
        .addJob(delivery4)
        .build();

    VehicleRoutingProblem vrp = vrpBuilder.build();

    final StateManager stateManager = new StateManager(vrp);

    ConstraintManager constraintManager = new ConstraintManager(vrp, stateManager);
    constraintManager.addLoadConstraint();
    constraintManager.addTimeWindowConstraint();

    VehicleFleetManager fleetManager =
        new InfiniteFleetManagerFactory(vrp.getVehicles()).createFleetManager();

    BestInsertionBuilder bestIBuilder =
        new BestInsertionBuilder(vrp, fleetManager, stateManager, constraintManager);
    bestIBuilder.setRouteLevel(2, 2);
    @SuppressWarnings("unused")
    InsertionStrategy bestInsertion = bestIBuilder.build();
  }
  @Test
  public void
      whenHavingOnlyServicesInOneProblem_andInsertionShouldBeMadeOnRouteLevel_itShouldAssertTrue() {
    /* get a vehicle type-builder and build a type with the typeId "vehicleType" and a capacity of 2
     */
    VehicleTypeImpl.Builder vehicleTypeBuilder =
        VehicleTypeImpl.Builder.newInstance("vehicleType").addCapacityDimension(0, 2);
    VehicleType vehicleType = vehicleTypeBuilder.build();

    /*
     * get a vehicle-builder and build a vehicle located at (10,10) with type "vehicleType"
     */
    VehicleImpl.Builder vehicleBuilder = VehicleImpl.Builder.newInstance("vehicle");
    vehicleBuilder.setStartLocation(Location.newInstance(10, 10));
    vehicleBuilder.setType(vehicleType);
    VehicleImpl vehicle = vehicleBuilder.build();

    /*
     * build deliveries, (implicitly picked up in the depot)
     * 1: (4,8)
     * 2: (4,12)
     * 3: (16,8)
     * 4: (16,12)
     */
    Delivery delivery1 =
        (Delivery)
            Delivery.Builder.newInstance("5")
                .addSizeDimension(0, 1)
                .setLocation(Location.newInstance(4, 8))
                .build();
    Delivery delivery2 =
        (Delivery)
            Delivery.Builder.newInstance("6")
                .addSizeDimension(0, 1)
                .setLocation(Location.newInstance(4, 12))
                .build();
    Delivery delivery3 =
        (Delivery)
            Delivery.Builder.newInstance("7")
                .addSizeDimension(0, 1)
                .setLocation(Location.newInstance(16, 8))
                .build();
    Delivery delivery4 =
        (Delivery)
            Delivery.Builder.newInstance("8")
                .addSizeDimension(0, 1)
                .setLocation(Location.newInstance(16, 12))
                .build();

    VehicleRoutingProblem.Builder vrpBuilder = VehicleRoutingProblem.Builder.newInstance();
    vrpBuilder
        .addVehicle(vehicle)
        //		vrpBuilder.addJob(shipment1).addJob(shipment2).addJob(shipment3).addJob(shipment4)
        .addJob(delivery1)
        .addJob(delivery2)
        .addJob(delivery3)
        .addJob(delivery4)
        .build();

    VehicleRoutingProblem vrp = vrpBuilder.build();

    final StateManager stateManager = new StateManager(vrp);

    ConstraintManager constraintManager = new ConstraintManager(vrp, stateManager);
    constraintManager.addLoadConstraint();
    constraintManager.addTimeWindowConstraint();

    VehicleFleetManager fleetManager =
        new InfiniteFleetManagerFactory(vrp.getVehicles()).createFleetManager();

    BestInsertionBuilder bestIBuilder =
        new BestInsertionBuilder(vrp, fleetManager, stateManager, constraintManager);
    bestIBuilder.setRouteLevel(2, 2);
    @SuppressWarnings("unused")
    InsertionStrategy bestInsertion = bestIBuilder.build();

    assertTrue(true);
  }
  @Before
  public void doBefore() {
    vehicle =
        VehicleImpl.Builder.newInstance("v").setStartLocation(Location.newInstance(0, 0)).build();
    vehicle2 =
        VehicleImpl.Builder.newInstance("v2")
            .setStartLocation(Location.newInstance(10, 10))
            .build();

    maxDistanceMap = new HashMap<>();
    maxDistanceMap.put(vehicle, 200d);
    maxDistanceMap.put(vehicle2, 200d);

    d1 = Delivery.Builder.newInstance("d1").setLocation(Location.newInstance(10, 10)).build();
    d2 = Delivery.Builder.newInstance("d2").setLocation(Location.newInstance(20, 15)).build();
    pickup = Pickup.Builder.newInstance("pickup").setLocation(Location.newInstance(50, 50)).build();
    s1 =
        Shipment.Builder.newInstance("s1")
            .setPickupLocation(Location.newInstance(35, 30))
            .setDeliveryLocation(Location.newInstance(20, 25))
            .build();

    newDelivery =
        Delivery.Builder.newInstance("new").setLocation(Location.newInstance(-10, 10)).build();

    vrp =
        VehicleRoutingProblem.Builder.newInstance()
            .setRoutingCost(new ManhattanCosts())
            .addVehicle(vehicle)
            .addVehicle(vehicle2)
            .addJob(d1)
            .addJob(d2)
            .addJob(s1)
            .addJob(pickup)
            .addJob(newDelivery)
            .build();

    route =
        VehicleRoute.Builder.newInstance(vehicle)
            .setJobActivityFactory(vrp.getJobActivityFactory())
            .addDelivery(d1)
            .addDelivery(d2)
            .addPickup(s1)
            .addPickup(pickup)
            .addDelivery(s1)
            .build();

    stateManager = new StateManager(vrp);

    traveledDistanceId = stateManager.createStateId("traveledDistance");

    com.graphhopper.jsprit.core.algorithm.state.VehicleDependentTraveledDistance traveledDistance =
        new com.graphhopper.jsprit.core.algorithm.state.VehicleDependentTraveledDistance(
            new TransportDistance() {
              @Override
              public double getDistance(
                  Location from, Location to, double departureTime, Vehicle vehicle) {
                return new ManhattanCosts().getDistance(from, to, departureTime, vehicle);
              }
            },
            stateManager,
            traveledDistanceId,
            Arrays.asList(vehicle, vehicle2));

    stateManager.addStateUpdater(traveledDistance);
    stateManager.informInsertionStarts(Arrays.asList(route), Collections.<Job>emptyList());
  }