Setting up rviz for the navigation stack