add debug rviz plugin