Now using OccupancyGrid to render, much better performance