#include <Servo.h>
#include <Ultrasonic.h>
const int trigPin = 8;
const int echoPin = 9;
const int servoPin = 7;
Servo servo;
float duration_us, distance_cm;
void setup ()
{
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
servo.attach(servoPin);
servo.write(0);
pinMode(10, OUTPUT);
pinMode(11, OUTPUT);
}
void loop ()
{
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
long duration = pulseIn(echoPin, HIGH);
int distance = duration * 0.0343 / 2;
Serial.print("Distance: ");
Serial.print(distance);
Serial.println(" cm");
delay(100);
if (distance>100)
{
digitalWrite(10, LOW);
digitalWrite(11, HIGH);
}
else
{
digitalWrite(10, HIGH);
digitalWrite(11, LOW);
}
if (distance<100)
{
servo.write(90);
}
else
{
servo.write (0);
}
}