private double calculateCost(String originMachine, String destinationMachine, AGV agent) { HashMap<String, Location> map = agent.getMachineLocation(); double cost = (agent.getLocation().distanceTo(map.get(originMachine)) + Location.distanceTo(map.get(originMachine), map.get(destinationMachine))) * agent.getCost(); return cost; }