Stap 5:
Code voor de auto's Arduino (degene die beheersing van de servo)
De bedrading is: + 5V tot Servo V +
GND aan Servo GND
pin 9 aan Servo Control
GND GND auto
PIN van A0 tot en met Rx pin 12 in de auto
OpenSquare 1.2-24/02/14
#include
Servo myservo; maken van servo-object om te bepalen van een servo
maximaal acht servo-objecten kan worden gemaakt
int pos1 = 80; variabele op te slaan van de servo positie
int pos2 = 120; variabele op te slaan van de servo positie
int vorige = 0; het gemiddelde
int inputPin = A0;
VOID Setup
{
Initialiseer seriële communicatie met de computer:
Serial.begin(9600);
myservo.attach(9); de servo op pin 9 hecht aan de servo-object
}
void loop {}
lezen van de sensor:
vorige = analogRead(inputPin);
delay(10); vertraging in tussen leest voor stabiliteit
Als (vorige < = 200 & & analogRead(inputPin) > = 200) {}
delay(1000);
Als (analogRead(inputPin) > = 200) {}
myservo.write(pos2); servo naar positie in de variabele 'pos' vertellen
}
else {}
myservo.write(Pos1); servo naar positie in de variabele 'pos' vertellen
}
delay(15);
}
}