Implements instance constraints in the ConstraintCollocator.

This is primarily to support specifying constraints for the start and end
conditions. It is a limited implementation but will cover a fair amout of
situations. Also:

- Simplified the args to Problem to be more universal.
- Added Tons' pendulum swing up example to show the use of the new constraints.