ai.libs.jaicore.search.exampleproblems.gridworld.GridWorldHeuristic Maven / Gradle / Ivy

package ai.libs.jaicore.search.exampleproblems.gridworld;

import org.api4.java.ai.graphsearch.problem.pathsearch.pathevaluation.IPathEvaluator;
import org.api4.java.datastructure.graph.ILabeledPath;

import ai.libs.jaicore.problems.gridworld.GridWorldNode;

public class GridWorldHeuristic implements IPathEvaluator {

	private final int targetX;
	private final int targetY;

	public GridWorldHeuristic(final int targetX, final int targetY) {
		super();
		this.targetX = targetX;
		this.targetY = targetY;
	}

	@Override
	public Double evaluate(final ILabeledPath node) {
		double x = Math.abs(this.targetX - node.getHead().getX());
		double y = Math.abs(this.targetY - node.getHead().getY());
		return Double.valueOf(x + y);
	}
}