Added most of the other parts, working on Dijkstras algo now