[BUG] Occupancy Map

Hi there,
there is a possible bug in the occupancy map generator, unless this is the desired behaviour.

The generation is related to the origin position. If the origin of the map is under a (colliding) mesh, the resulting map is incorrect.

It seems that the origin defines what is free, and everything else is generated accordingly.