Semi-autonomous coordinated exploration in rescue scenarios