Autonomous exploration for search and rescue robots