| 1234567891011121314151617181920212223242526272829303132333435363738394041424344 |
- package boebot;
- import stamp.core.*;
- public class Lijnvolger
- {
- boolean qtiDigValue;
- IrLijnvolger IrMidden, IrRechts, IrLinks, IrLinksVoor;
- public Lijnvolger()
- {
- //eerste is input (witte draad), tweede is output (rode draad)
- IrMidden = new IrLijnvolger(6, 5);
- IrRechts = new IrLijnvolger(4, 3);
- IrLinks = new IrLijnvolger(8, 7);
- IrLinksVoor = new IrLijnvolger(10,9);
- }
- public int readSensor()
- {
- int waarde = -1;
- if(IrMidden.readSensorLijnvolger() && IrRechts.readSensorLijnvolger() && IrLinks.readSensorLijnvolger() && IrLinksVoor.readSensorLijnvolger()){
- waarde = 5;
- }
- else if(IrMidden.readSensorLijnvolger() && IrRechts.readSensorLijnvolger() && IrLinks.readSensorLijnvolger()){
- waarde = 4;
- } else if(IrMidden.readSensorLijnvolger()){
- waarde = 0;
- }
- else if(IrRechts.readSensorLijnvolger()){
- waarde = 1;
- }
- else if(IrLinks.readSensorLijnvolger()){
- waarde = 2;
- }
- else{
- waarde = 3;
- }
- return waarde;
- }
- }
|