Step 5 – Debugging the Gazebo- MoveIt! interface