Added standalone tether tightening functionality.

Given a path and a collection of obstacles, the tightened path can be
obtained.