Heuristic added (interface) and the one for jME, working on PathFinder interface.