Added costmaps to cloud and tests related to it