Path finding code updated. Still need to fix missing edge problem for GO trees.