Add SorterTest and the start of Dijkstra algorithm