Debugged catkin integration