Robot code: drive, shift, stop