OccupancyGrid fixed to some degree