Robot code for SR competition