IrDetectie.java 665 B

1234567891011121314151617181920212223242526272829303132
  1. package boebot;
  2. import stamp.core.*;
  3. public class IrDetectie{
  4. PWM irZender;
  5. boolean irDetect;
  6. private int pinRead;
  7. private int pinSend;
  8. public IrDetectie(int pinS, int pinR){
  9. irZender = new PWM (CPU.pins[pinS], 1, 2);
  10. irZender.stop();
  11. pinRead = pinR;
  12. pinSend = pinS;
  13. }
  14. public void setPinRead(int pin){
  15. pinRead = pin;
  16. }
  17. public boolean detect(){
  18. for(int i = 0; i < 20; i++){
  19. irZender.start();
  20. CPU.delay(5);
  21. irDetect = CPU.readPin(CPU.pins[pinRead]);
  22. irZender.stop();
  23. CPU.delay (20);
  24. }
  25. CPU.writePin(pinSend, false);
  26. return !irDetect;
  27. }
  28. }