1
12
13#include <Servo.h>
14
15#define trigPin 7
16#define echoPin 8
17
18Servo myServo;
19const int servoPin = 9;
20int servoPos = 90;
21
22void setup() {
23 Serial.begin(9600);
24 myServo.attach(servoPin);
25 pinMode(trigPin, OUTPUT);
26 pinMode(echoPin, INPUT);
27}
28
29void loop() {
30 long duration, distance;
31 digitalWrite(trigPin, LOW);
32 delayMicroseconds(2);
33 digitalWrite(trigPin, HIGH);
34 delayMicroseconds(10);
35 digitalWrite(trigPin, LOW);
36 duration = pulseIn(echoPin, HIGH);
37 distance = duration / 58;
38
39 if (distance >= 200 || distance <= 0) {
40 Serial.println("Out of range");
41 }
42 if (distance <= 40) {
43 myServo.write(45);
44 delay(500);
45 myServo.write(servoPos);
46 }
47
48 Serial.print(distance);
49 Serial.println(" cm");
50 delay(250);
51
52}
53