I found this algorithm here.
I have a problem, I cant seem to understand how to set up and pass my heuristic function.
static public Path
Yes, you'd need to modify the code, as there is no possibilty to fit an estimate method in there with two TNodeparameters.
estimate
TNode