Merge pull request #6 from NicholasAStuart/master

Added Dijkstra's and did some code cleanup.
commented out test cases cause they sometime freeze/lock up the JVM.