first draft of slam
More slam implementation
added cmd line parametrization, noise to simulator, rewritten SlamManager (still not working...)
Refactored map element visualization configuration
small fix to starting simulation thread