Heterogeneous multi-robot systems for Search and Rescue