Basic dijkstra algorithm, do not build yet, problem with testing.
should be able after fixing build to CTRL+Click to have a path output in the console if enough nodes available