Added rviz file
Can publish gridcells
Added pose estimation and goal selection topic subscriptions