- methods formerly taking a const reference to Problem as input now take
    a shared pointer to const Problem.

  - create one solver by waypoint,
  - detect for each parameterizable constraint and each waypoint if
    - the right hand side is equal to the right hand side for initial config,
    - the right hand side is equal to the right hand side for goal config,
    - the right hand side is equal to the right hand side for previous waypoint.
  - iteratively solve waypoints after initializing right hand sides.