Het programma kan er als volgt uitzien:
#include <Servo.h> Servo myservo; int LDR1 = 0; int LDR2 = 5; int val1; int val2; int pos = 1; int okled = 7; int nokled = 6; void setup() { Serial.begin(9600); myservo.attach(9); pinMode (okled,OUTPUT); pinMode (nokled,OUTPUT); } void loop() { digitalWrite (nokled, HIGH); digitalWrite (okled, LOW); for(pos = 1; pos < 180; pos += 1) { val1 = analogRead(LDR1); val2= analogRead(LDR2); Serial.print(val1); Serial.print(" "); Serial.print (val2); Serial.print(" "); Serial.println(pos); myservo.write(pos); digitalWrite (nokled, HIGH); digitalWrite (okled, LOW); delay(50); if ((val1 < 485 ) and (val2 < 505)) { digitalWrite (okled, HIGH); digitalWrite (nokled, LOW); delay(5000); break; } } }
|