Removed dependencies to slamnode multislamnode classes in
localization classes. Therefore, multi/single slam can be
combined more easily. Added a initpush method for mapping
thread.
However, a method is needed to clean the footprint of the robot
in the tsdgrid.