Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define THRESHOLD 45
- task main()
- {
- SetSensorTouch(IN_1);
- SetSensorTouch(IN_2);
- OnFwdReg(OUT_A,50,OUT_REGMODE_SPEED);
- OnFwdReg(OUT_B,70,OUT_REGMODE_SPEED);
- while (true)
- {
- if (SENSOR_1 == 1)
- {
- OnRevReg(OUT_B,50,OUT_REGMODE_SPEED);
- OnFwdReg(OUT_A,60,OUT_REGMODE_SPEED);
- until(SENSOR_1 != 1);
- OnFwdReg(OUT_A,50,OUT_REGMODE_SPEED);
- OnFwdReg(OUT_B,70,OUT_REGMODE_SPEED);
- }
- if (SENSOR_2 == 1)
- {
- OnRevReg(OUT_B,50,OUT_REGMODE_SPEED);
- OnFwdReg(OUT_A,60,OUT_REGMODE_SPEED);
- until (SENSOR_2 != 1);
- OnFwdReg(OUT_A,50,OUT_REGMODE_SPEED);
- OnFwdReg(OUT_B,70,OUT_REGMODE_SPEED);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement