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

Now you cannot move the environment with the robot anymore as it is fixed to the Gazebo ```world``` frame.