fixed center of gravity and inertia formulas
Merge branch 'velocity_interface_controller_indigo' of github.com:ipa-fxm/cob_common into velocity_interface_controller_indigo
Merge branch 'velocity_interface_controller_indigo' of github.com:ipa-fxm-fm/cob_common into indigo_dev