Working Perfectly with custom gazebo controllers