3D localization, mapping and path planning for search and rescue operations | IEEE Conference Publication | IEEE Xplore