added center of mass and moment of inertia computes
Merge remote-tracking branch 'origin/develop' into develop