Stap 7: De code
#include
int positie = 90;
int stepDeg = 20;
int gladheid = 10;
int countL = 0;
int countR = 0;
int servoPin = 11;
Servo-object maken
Servo trackerServo;
VOID Setup {}
koppel van de servo aan onze object
trackerServo.attach(servoPin);
trackerServo.write(Position);
}
void loop {}
lezen van de ir-straal
for (int i = 0; ik < = 1; i ++) {}
int sensorValueLeft = analogRead(A5);
int sensorValueRight = analogRead(A3);
if(sensorValueLeft == 0) {}
countL ++;
}
if(sensorValueRight == 0) {}
countR ++;
}
} //end voor
Controleer links en draaien
Als (countL > 1 & & countR == 0) {}
voor (int x = 0; x < = stepDeg; x ++) {}
Positie--;
trackerServo.write(Position);
delay(Smoothness);
}
}
selectievakje juiste en draaien
Als (countR > 1 & & countL == 0) {}
voor (int x = 0; x < = stepDeg; x ++) {}
Positie ++;
trackerServo.write(Position);
delay(Smoothness);
}
}
countL = 0;
countR = 0;
}