Robotic syna (4 / 4 steg)
Steg 4: Montering av servo och programmering
Ögat fungerar på följande sätt: för att upptäcka ett objekt framför varje sensor (upp till 40 cm, justerbar), sensor ändringarna anges vid utfarten från Hi till Lo (av 5volts till noll) då Arduino inser att det fanns en ändra tillstånd i en av dess hamnar så, enligt programvaran, servomotor att rotera ögat till förinställd position.
Detta var en ansökan av didaktiska användning av IR-sensorer. Många andra program är möjliga. Begränsningen är din fantasi. Hoppas du gillar.
Programvara:
#include < Servo.h > / / include servo bibliotek
Servo pescoco; skapa objekt för att styra en servo servo
int pos = 0;
int irdireita = 10;
int iresquerda = 12;
int ircentro = 11;
int tempo = 50;
Ogiltiga inställningar () {
pescoco.attach(9); tillmäter objektet servo servo på pin 9
pinMode (irdireita, ingång); ställa in pin irdireita (pin10) som indata
pinMode (iresquerda, ingång); ställa in pin iresquerda (pin12) som indata
pinMode (ircentro, ingång); ställa in pin ircentro (pin11) som indata
}
void loop() {
int valdireita = digitalRead (irdireita);
int valesquerda = digitalRead (iresquerda);
int valcentro = digitalRead (ircentro);
om (valdireita == låg) {
pescoco.write(180);
POS = (180);
fördröjning (tempo);
}
annat if(valesquerda == LOW) {
pescoco.write (0);
POS = (0);
fördröjning (tempo);
}
annat if (valcentro == låg) {
pescoco.write (90).
POS = (90);
fördröjning (tempo);
}
annat {
pescoco.write (pos);
fördröjning (tempo);
}
}