Modifying the function to include the body frame transformation
Merge branch 'develop' of github.com:columbia-drc/openHubo into develop