Lijnvolger.java 885 B

1234567891011121314151617181920212223242526272829303132333435363738394041
  1. package boebot;
  2. import stamp.core.*;
  3. public class Lijnvolger
  4. {
  5. boolean qtiDigValue;
  6. IrLijnvolger IrMidden;
  7. IrLijnvolger IrRechts;
  8. IrLijnvolger IrLinks;
  9. public Lijnvolger()
  10. {
  11. IrMidden = new IrLijnvolger(6, 5);
  12. IrRechts = new IrLijnvolger(4, 3);
  13. IrLinks = new IrLijnvolger(8, 7);
  14. }
  15. public int readSensor()
  16. {
  17. int waarde = -1;
  18. if(IrL1.readSensorLijnvolger() && IrL2.readSensorLijnvolger() && IrL3.readSensorLijnvolger()){
  19. waarde = 4;
  20. } else
  21. if(IrL1.readSensorLijnvolger()){
  22. waarde = 0;
  23. }
  24. else if(IrL2.readSensorLijnvolger()){
  25. waarde = 1;
  26. }
  27. else if(IrL3.readSensorLijnvolger()){
  28. waarde = 2;
  29. }
  30. else{
  31. waarde = 3;
  32. }
  33. return waarde;
  34. }