Multiple Bugs resolved, 
All operation working, Saving correctly to disk to
Missing Cost Function and Djkstra