presented at event 2011 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR) Conference