Added octomap building with amcl localization and move base and fixed issue with octomap subscribing to the right pointcloud