Add code from [mocaptoolbox_py](https://github.com/fourMs/mocaptoolbox_py?organization=fourMs&organization=fourMs) and more stuff from the Mocap toolbox for Matlab.
Add code from mocaptoolbox_py and more stuff from the Mocap toolbox for Matlab.