A Framework For Cooperative 3D Mapping Of Unstructured Environments