Pipeline working with rviz debug output