Begin rviz plugin visualizer