void DecideTurn() { rightF = Adc_IR(IR_RI_F); rightF = Adc_IR(IR_RI_F); LED1=~LED1; rightR = Adc_IR(IR_RI_R); rightR = Adc_IR(IR_RI_R); LED1=~LED1; leftF = Adc_IR(IR_LE_F); leftF = Adc_IR(IR_LE_F); LED1=~LED1; leftR = Adc_IR(IR_LE_R); leftR = Adc_IR(IR_LE_R); LED1=~LED1; if(rightF>15 || rightR > 15) { setMainState(5); } else if(leftF > 15 || leftR > 15) { setMainState(6); } else { SetTurn90(700, 0); } }
void conDoSelect() { setMainState(MODE_MAIN_MENU); setupCon();//reset variables so that we redraw the next time we come to this menu. }