Added a method to free a certain area (robot footprint) around
a certain position in the tsd grid. This is necessary for the
multi slam,