#include <Servo.h>
#define TRIG_PIN_1 9
#define ECHO_PIN_1 8
Servo s1;
void setup() {
s1.attach(5);
Serial.begin(9600);
pinMode(TRIG_PIN_1, OUTPUT);
pinMode(ECHO_PIN_1, INPUT);
}
void loop() {
for (int i =0; i<=90;i++){
s1.write(i);
delay(10);
}
delay(500);
sensor();
for (int j =90; j>=0;j--){
s1.write(j);
delay(10);
}
sensor();
}
void sensor(){
float duration1, distance1;
digitalWrite(TRIG_PIN_1, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN_1, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN_1, LOW);
duration1 = pulseIn(ECHO_PIN_1, HIGH);
distance1 = duration1 * 0.034 / 2;
Serial.print("Sensor 1: ");
Serial.print(distance1);
Serial.println(" cm");
}