#include <ESP32Servo.h>
int trigpin = 4;
int echopin = 5;
int servopin = 34;
float duration, distance;
Servo servosatu;
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
pinMode(trigpin, OUTPUT);
pinMode(echopin, INPUT);
servosatu.attach(servopin);
}
void loop() {
// put your main code here, to run repeatedly:
// this speeds up the simulation
digitalWrite(trigpin, HIGH);
delayMicroseconds(10);
digitalWrite(trigpin, LOW);
duration = pulseIn(echopin, HIGH);
distance = 0.017 * duration;
Serial.print("Distance = ");
Serial.print(distance);
Serial.println("cm");
delay(1000);
if (distance <= 10){
servosatu.write(180);
}
else{
servosatu.write(0);
}
}
Loading
esp32-devkit-c-v4
esp32-devkit-c-v4