fix environment to gazebo world frame + proper interia
changes due to renaming
Merge pull request #71 from ipa-fxm/fix_environment_inertia

[Indigo] fix environment to gazebo world frame + proper interia