Gazebo support

Changes for supporting Gazebo integration.