excluding amcl solves the map request problem
running with initializing matrix
added functionality to initialize and publish a map
publish map based on an internal matrix