#define PIN_TRIG 25
#define PIN_ECHO 26
#define LEFT_PIN 19
#define RIGHT_PIN 18
void changeState(int distanceCM){
if (distanceCM < 10) {
digitalWrite(RIGHT_PIN, LOW);
} else {
digitalWrite(RIGHT_PIN, HIGH);
}
}
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(PIN_TRIG, OUTPUT);
pinMode(PIN_ECHO, INPUT);
pinMode(LEFT_PIN, OUTPUT);
pinMode(RIGHT_PIN, OUTPUT);
digitalWrite(RIGHT_PIN, HIGH);
digitalWrite(LEFT_PIN, HIGH);
Serial.println("Project ready");
}
void loop() {
// put your main code here, to run repeatedly:
digitalWrite(PIN_TRIG, HIGH);
delayMicroseconds(10);
digitalWrite(PIN_TRIG, LOW);
// Считываем результат:
int duration = pulseIn(PIN_ECHO, HIGH);
int distanceCM = duration / 58;
changeState(distanceCM);
delay(10); // this speeds up the simulation
}