Added a binary heap, a better implementation of fast Dijkstra, and a lot of tests.
Fixed heap and added more tests for Dijkstra's algorithm.