Arduino och LEGO tåg (5 / 6 steg)
Steg 5: Arduino skiss
Detta är den Arduino skiss används för att styra sensorer, servon och tåg.
Det är tillgänglig på min github repos: Github Repo
< br >< p > / * < br > * Arduino och LEGO Power Functions < br > * dark_storm
*/
#include
#include
Servo servoMain; Definiera våra Servo
int curSpeed = 0;
IR ledde på port 13
LEGOPowerFunctions lego(13);
int irPin = 12.
int count = 0;
int buttonState = 0;
int fwdRev = 0;
int stationPin = 2;
int buzzerPin = 11;
irPin - Lap Sensor
stationpin-Station Sensor
buzzerpin - Summer pin
void setup()
{
Serial.BEGIN(9600);
pinMode (irPin, ingång);
pinMode(stationPin,INPUT);
servoMain.attach(10); servo på digital stift 10
pinMode(buzzerPin,OUTPUT);
}
void loop()
{
om (digitalRead(irPin) == 0)
{
greve ++;
Delay(3000);
}
om (greve < = 2)
{
LEGO. SingleOutput (PWM, PWM_FWD5, röd, CH1);
Delay(100);
om (digitalRead(stationPin) == 0)
{
LEGO. SingleOutput (PWM, PWM_FLT, röd, CH1);
servoMain.write(0); Aktivera Servo vänster till 45 grader
Delay(2000);
Tone(11,2000,1000);
Delay(500);
}
}
annat
{
servoMain.write(90); Aktivera Servo vänster till 45 grader
Count = 0;
}
} < /p >