Make constructors public in all constraint classes.
Use Eigen::Ref for Jacobian matrices.
Add setter and getter for reference values of RelativePosition.
Implement constraint on relative transformation between two joints.