reverted last push
Merge branch 'bigchange-progress' of https://github.com/group-8-robotics-of-destruction/s8_mapper into bigchange-progress
now initialization is done on first add_node call