Code: #pragma config(Sensor, S2, colorR, sensorEV3_Color) #pragma config(Sensor, S3, colorL, sensorEV3_Color) #pragma config(Motor, motorB, , tmotorEV3_Large, PIDControl, reversed, driveRight, encoder) #pragma config(Motor, motorC, , tmotorEV3_Large, PIDControl, reversed, driveLeft, encoder)
task main() { float colorLeft ; float colorRight;
float reflectedLeft; float reflectedRight;
while(true){ setSensorMode(colorR,modeEV3Color_Color); setSensorMode(colorL,modeEV3Color_Color); sleep( ?? ); // ???? #### ##### <= ###[color=#FF0000] How much time do i need minimum? [/color]### colorLeft = SensorValue[colorL]; colorRight = SensorValue[colorR]; setSensorMode(colorR,modeEV3Color_Reflected); setSensorMode(colorL,modeEV3Color_Reflected); [color=#FF0000] sleep( ?? ); // ???? #### #####[/color] reflectedLeft =SensorValue[colorL]; reflectedRight =SensorValue[colorR];
if(reflectedLeft >90){ //stop motor B and C }else{ //motor B and C on } if(colorLeft==3){ //green //go Left } if(colorRight ==3){ //green //go Right } }
} |