2013 Oct version, uses A* idea for PathFinder