Stap 12: Programma arduino
#include < Servo.h >
Servo servo1; maken van servo-object om te bepalen van een servo
Servo servo2;
int pos = 0; variabele op te slaan van de servo positie
int licht = 0; waarde van de pot leest
int prox = 0;
int servo1Pos = 0; waarde output naar de PWM (analoge uitgang)
int servo2Pos = 0; waarde output naar de PWM (analoge uitgang)
VOID Setup {}
seriële communicatie 9600 bps te initialiseren:
Serial.begin(9600);
servo1.attach(9); de servo op pin 9 hecht aan de servo-object
servo2.attach(11);
}
void loop {}
Lees de analoge waarde:
licht = analogRead(A0);
ProX = analogRead(A1);
het worden toegewezen aan de servo-uitvoer:
Als (licht > 400) {servo1Pos = 0;}
Als (licht < = 400) {servo1Pos = 180;}
Als (prox > 400) {servo2Pos = 180;}
Als (prox < = 400) {servo2Pos = 0;}
de servo-uitvoer wijzigen
servo1.write(servo1Pos);
servo2.write(servo2Pos);
vertellen van de servo naar positie
de resultaten naar de seriële monitor wilt afdrukken:
Serial.Print ("licht =");
Serial.Print(Light);
Serial.Print ("servo1 =");
Serial.println(servo1Pos);
Serial.Print ("prox =");
Serial.Print(ProX);
Serial.Print ("servo2 =");
Serial.println(servo2Pos);
wacht 10 milliseconden voordat de next-lus
voor de analoog / digitaal-converter te regelen
na de laatste lezing:
delay(10);
