program for robot R2 of FTC team 1302