|
|
@@ -19,21 +19,23 @@ public class Lijnvolger
|
|
|
public int readSensor()
|
|
|
{
|
|
|
int waarde = -1;
|
|
|
- if(IrMidden.readSensorLijnvolger()){
|
|
|
+ if(IrL1.readSensorLijnvolger() && IrL2.readSensorLijnvolger() && IrL3.readSensorLijnvolger()){
|
|
|
+ waarde = 4;
|
|
|
+ } else
|
|
|
+ if(IrL1.readSensorLijnvolger()){
|
|
|
waarde = 0;
|
|
|
}
|
|
|
|
|
|
- else if(IrRechts.readSensorLijnvolger()){
|
|
|
- waarde = 1;
|
|
|
+ else if(IrL2.readSensorLijnvolger()){
|
|
|
+ waarde = 1;
|
|
|
}
|
|
|
|
|
|
- else if(IrLinks.readSensorLijnvolger()){
|
|
|
- waarde = 2;
|
|
|
+ else if(IrL3.readSensorLijnvolger()){
|
|
|
+ waarde = 2;
|
|
|
}
|
|
|
else{
|
|
|
- waarde = 3;
|
|
|
+ waarde = 3;
|
|
|
}
|
|
|
return waarde;
|
|
|
- }
|
|
|
|
|
|
}
|