Implement the base case of the bmssp algorithm

[Sirivasv]

Uses a small Dijkstra like algorithm and a priority queue kind of data structure (see #41 ).

For reference:
https://dl.acm.org/doi/pdf/10.1145/3717823.3718179