int trigPin = 12;
int echoPin = 13;
int mtp1 = 8;
int mtp2 = 9;
int mtp3 = 10;
int mtp4 = 11;
int gry;
void setup(){
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
Serial.begin(9600);
pinMode(mtp1, OUTPUT);
pinMode(mtp2, OUTPUT);
pinMode(mtp3, OUTPUT);
pinMode(mtp4, OUTPUT);
}
void loop(){
int gry = 0;
int sure, uzaklik;
digitalWrite(trigPin, HIGH);
delayMicroseconds(1000);
digitalWrite(trigPin, LOW);
sure = pulseIn(echoPin, HIGH);
uzaklik = sure/58;
Serial.print("uzaklik: ");
Serial.println(uzaklik);
delay(200);
if(uzaklik <= 7){
gry = gry+1 ;
delay(1000);
if(gry > 0){
if(gry == 1){
digitalWrite(mtp1, HIGH);
digitalWrite(mtp2, LOW);
digitalWrite(mtp3, HIGH);
digitalWrite(mtp4, LOW);
delay(5000);
digitalWrite(mtp1, LOW);
digitalWrite(mtp2, LOW);
digitalWrite(mtp3, LOW);
digitalWrite(mtp4, LOW);
Serial.println(gry);
}
if(gry == 2){
digitalWrite(mtp1, LOW);
digitalWrite(mtp2, HIGH);
digitalWrite(mtp3, LOW);
digitalWrite(mtp4, HIGH);
delay(5000);
digitalWrite(mtp1, LOW);
digitalWrite(mtp2, LOW);
digitalWrite(mtp3, LOW);
digitalWrite(mtp4, LOW);
Serial.println(gry);
}
if(gry == 3){
digitalWrite(mtp1, HIGH);
digitalWrite(mtp2, LOW);
digitalWrite(mtp3, LOW);
digitalWrite(mtp4, LOW);
delay(5000);
digitalWrite(mtp1, LOW);
digitalWrite(mtp2, LOW);
digitalWrite(mtp3, LOW);
digitalWrite(mtp4, LOW);
Serial.println(gry);
}
Serial.println(gry);
}
}
}