Remove rviz dependency