Control algorithms for rescue robot RUDA