Added a method to get the topic for the controller state callback.

Gazebo test failing. Need to fix it before merging.