PathAlgorithm updates - ready to test!

@dgearhart @gknisely  @kevinkreiser