Introduction of Constraint in the rnea.

src/multibody/constraint.hpp

src/multibody/joint.hpp

src/multibody/model.hpp

src/spatial/motion.hpp

unittest/rnea.cpp