void turn_right(int y)
{
OnFwd(OUT_A); OnRev(OUT_C); Wait(y); Off(OUT_A+OUT_C);
}
task main() { SetSensor(SENSOR_1,SENSOR_TOUCH); SetSensor(SENSOR_3,SENSOR_TOUCH); OnFwd(OUT_A+OUT_C); Wait(200); until ((SENSOR_1 == 1) && (SENSOR_3 == 1)); turn_right(110); OnFwd(OUT_A+OUT_C); Wait(200); SetSensor(SENSOR_3,SENSOR_TOUCH); while(true) { if (SENSOR_3 == 0) { OnFwd(OUT_A); Float(OUT_C); } else { Float(OUT_C); OnFwd(OUT_A); } } Off(OUT_A+OUT_C); }