#include <Servo.h>
Servo myServo;
int ang = 90;
#define Trig 10
#define Echo 11
long width, distance;
void printData()
{
Serial.print("Angle is:");
Serial.print(ang);
Serial.print("\n");
}
void setup()
{
Serial.begin (9600);
pinMode(Trig, OUTPUT);
pinMode(Echo, INPUT);
myServo.attach(12);
myServo.write(ang);
}
void loop() {
digitalWrite(Trig, 0);
delayMicroseconds(2);
digitalWrite(Trig, 1);
delayMicroseconds(10);
digitalWrite(Trig, 0);
width = pulseIn(Echo, 1);
distance = width/58.2;
Serial.print(" Distance is: ");
Serial.print(distance);
Serial.println(" cm");
if (distance<100)
{
for(ang=90;ang>=0;ang-=10)
{
myServo.write(ang);
printData();
delay(500);
}
delay (3000);
for(ang=0;ang<=90;ang+=10)
{
myServo.write(ang);
printData();
delay(500);
}
}
delay(1000);
}