Graph path finding

done simply tested