Restoring connection between moveit! and Gazebo

TODO:
- fix joint names