Code:
// 14-19
//Sensoren
const int V_LINKS = 14;
const int V_MITTE = 15;
const int V_RECHTS = 16;
const int H_LINKS = 17;;
const int H_MITTE = 18;;
const int H_RECHTS = 19;
//Motoren
const int LINKS = 6;
const int RECHTS = 5;
const int VOR = 4;
const int ZURUECK = 2;
const int PWM = 3;
int pwm = 127;
void setup() {
// put your setup code here, to run once:
pinMode(V_LINKS, INPUT);
pinMode(V_MITTE, INPUT);
pinMode(V_RECHTS, INPUT);
pinMode(H_LINKS, INPUT);
pinMode(H_MITTE, INPUT);
pinMode(H_RECHTS, INPUT);
pinMode(LINKS, OUTPUT);
pinMode(RECHTS, OUTPUT);
pinMode(VOR, OUTPUT);
pinMode(ZURUECK, OUTPUT);
pinMode(PWM, OUTPUT);
}
void loop() {
analogWrite(PWM, pwm);
if (digitalRead(V_MITTE) == LOW)
{
digitalWrite(ZURUECK, HIGH);
digitalWrite(VOR, LOW);
digitalWrite(LINKS, HIGH);
digitalWrite(RECHTS, HIGH);
}
else if (digitalRead(V_LINKS) == LOW)
{
digitalWrite(ZURUECK, HIGH);
digitalWrite(VOR, LOW);
digitalWrite(RECHTS, HIGH);
digitalWrite(LINKS, LOW);
}
else if (digitalRead(V_RECHTS) == LOW)
{
digitalWrite(ZURUECK, HIGH);
digitalWrite(VOR, LOW);
digitalWrite(LINKS, HIGH);
digitalWrite(RECHTS, LOW);
}
else if (digitalRead(H_MITTE) == LOW)
{
digitalWrite(VOR, HIGH);
digitalWrite(ZURUECK, LOW);
digitalWrite(LINKS, HIGH);
digitalWrite(RECHTS, HIGH);
}
else if (digitalRead(H_LINKS) == LOW)
{
digitalWrite(VOR, HIGH);
digitalWrite(ZURUECK, LOW);
digitalWrite(RECHTS, HIGH);
digitalWrite(LINKS, LOW);
}
else if (digitalRead(H_RECHTS) == LOW)
{
digitalWrite(VOR, HIGH);
digitalWrite(ZURUECK, LOW);
digitalWrite(LINKS, HIGH);
digitalWrite(RECHTS, LOW);
}
else
{
digitalWrite(VOR, HIGH);
digitalWrite(ZURUECK, HIGH);
digitalWrite(LINKS, HIGH);
digitalWrite(RECHTS, HIGH);
}
//delay(30);
}
Lesezeichen