added unit tests
added line segment between feasible footsteps