Assembly Constraints and Multibody Dynamics code

The MbD theory is at https://github.com/Ondsel-Development/MbDTheory
