#include <Servo.h>
const int trigPin = 9;
const int echoPin = 10;
const int servoPin = 11;
const int detectionDistance = 50; // Distance in cm to detect an object
Servo myServo;
void setup() {
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
myServo.attach(servoPin);
myServo.write(0); // Initial position of the servo
}
void loop() {
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = duration * 0.034 / 2;
Serial.print("Distance: ");
Serial.println(distance);
if (distance < detectionDistance) {
myServo.write(120); // Rotate servo to 120 degrees
} else {
myServo.write(0); // Return servo to 0 degrees
}
delay(500);
}
No comments:
Post a Comment