add DijkstraSP and tests