Update rviz config, add launch file to repo, fix bug in pathfollowing