Activated occupancy grid visualization.
Merge remote-tracking branch 'origin/feature/occupancy_grid_visualization' into feature/occupancy_grid_visualization