Lijnvolger.java 1.1 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344
  1. package boebot;
  2. import stamp.core.*;
  3. public class Lijnvolger
  4. {
  5. boolean qtiDigValue;
  6. IrLijnvolger IrMidden, IrRechts, IrLinks, IrLinksVoor;
  7. public Lijnvolger()
  8. {
  9. //eerste is input (witte draad), tweede is output (rode draad)
  10. IrMidden = new IrLijnvolger(6, 5);
  11. IrRechts = new IrLijnvolger(4, 3);
  12. IrLinks = new IrLijnvolger(8, 7);
  13. IrLinksVoor = new IrLijnvolger(10,9);
  14. }
  15. public int readSensor()
  16. {
  17. int waarde = -1;
  18. if(IrMidden.readSensorLijnvolger() && IrRechts.readSensorLijnvolger() && IrLinks.readSensorLijnvolger() && IrLinksVoor.readSensorLijnvolger()){
  19. waarde = 5;
  20. }
  21. else if(IrMidden.readSensorLijnvolger() && IrRechts.readSensorLijnvolger() && IrLinks.readSensorLijnvolger()){
  22. waarde = 4;
  23. } else if(IrMidden.readSensorLijnvolger()){
  24. waarde = 0;
  25. }
  26. else if(IrRechts.readSensorLijnvolger()){
  27. waarde = 1;
  28. }
  29. else if(IrLinks.readSensorLijnvolger()){
  30. waarde = 2;
  31. }
  32. else{
  33. waarde = 3;
  34. }
  35. return waarde;
  36. }
  37. }