final double travelCost = this.costFunction.getLinkTravelDisutility(l, currTime, this.person, this.vehicle); final AStarNodeData data = getData(n); if (!data.isVisited(getIterationId())) { double remainingTravelCost = estimateRemainingTravelCost(n, toNode); visitNode(n, data, pendingNodes, currTime + travelTime, currCost + travelCost, remainingTravelCost, l);