Added a dijkstra search
Refactored nodes to have variable number of connections (untested)