Add "rviz" as the dependent package