ConstraintCollocator clean up.

- Moved parse_free into utils.
- Removed the unfinished continous system class from direct_collocation.py
- Cleaned up the documentation of ConstraintCollocator.