Short Path Algorithm