Issue/torso inertias

Introducing inertia macros for correct torso inertias