modified ros tutorial to visualize as well