Optimize occupancy grid visualization

does not update scale of the cubes of occupancy grid if no need to update.