Fixing issue https://github.com/robotology-playground/icub_gazebo/issues/5