Finish up initial shortest paths bench implementation