CoMap - Cooperative Autonomous Multi-Vehicle Mapping system