Stap 17: Smart auto code
#include
#define trigPin 12
#define echoPin 13
#define trigPin1 8
#define echoPin1 7
int vlag = 0, Markering1 = 0, graaf = 0;
char val;
AF_DCMotor motor2 (2, MOTOR12_64KHZ);
AF_DCMotor motor4 (4, MOTOR12_64KHZ);
VOID Setup {}
Serial.begin(9600);
pinMode (trigPin, OUTPUT);
pinMode (echoPin, INPUT);
pinMode (trigPin1, OUTPUT);
pinMode (echoPin1, INPUT);
Motor2.setSpeed(500);
motor4.setSpeed(500);
}
void loop {}
Als (graaf == 0) {}
Serial.println ("Please Press 1 autoparking inschakelen");
count = count + 1;
}
Als (Serial.available()) / / indien gegevens beschikbaar om te lezen
{
Val = Serial.read(); Lees het en sla het in de 'val'
}
Als (val == '1') / / als de 'H' werd ontvangen
{
Markering1 = 1;
}
Als (vlag == 0 & & Markering1 == 1) {}
Serial.println ("Auto auto parkeren ingeschakeld! Uw auto zal spoedig worden geparkeerd ");
Motor2.run(BACKWARD);
motor4.run(BACKWARD);
delay(4000);
Motor2.run(release);
motor4.run(release);
delay(500);
lange duur, afstand, distance1, Duur1;
digitalWrite (trigPin, laag);
delayMicroseconds(2);
digitalWrite (trigPin, hoge);
delayMicroseconds(10);
digitalWrite (trigPin, laag);
duur = pulseIn (echoPin, hoge);
afstand = (duur / 2) / 29.1;
delay(2000);
digitalWrite (trigPin1, laag);
delayMicroseconds(2);
digitalWrite (trigPin1, hoge);
delayMicroseconds(10);
digitalWrite (trigPin1, laag);
Duur1 = pulseIn (echoPin1, hoge);
distance1 = (Duur1 / 2) / 29.1;
delay(2000);
Als (afstand > 40) {}
Motor2.run(BACKWARD);
motor4.run(forward);
delay(1000);
Motor2.run(release);
motor4.run(release);
delay(500);
Motor2.run(BACKWARD);
motor4.run(BACKWARD);
delay(2500);
Motor2.run(release);
motor4.run(release);
Serial.println ("uw auto geparkeerd is");
vlag = 1;
}
anders als (distance1 > 40) {}
Motor2.run(forward);
motor4.run(BACKWARD);
delay(970);
Motor2.run(release);
motor4.run(release);
delay(500);
Motor2.run(BACKWARD);
motor4.run(BACKWARD);
delay(2500);
Motor2.run(release);
motor4.run(release);
Serial.println ("uw auto geparkeerd is veilig! Dank u ");
vlag = 1;
}
}
}