#include <Servo.h>
#define trigPin 3
#define echoPin 2
#define sw1 8
long pulse_echo;
float distance;
int pos = 0;
int x = 0;
Servo servo1;
Servo servo2;
unsigned int val;
void setup()
{
  Serial.begin(9600);
  pinMode (trigPin, OUTPUT);
  pinMode (echoPin, INPUT);
  pinMode (sw1 , INPUT_PULLUP);
  servo1.attach(13, 500, 2500); 
  servo2.attach(12, 500, 2500); 
}
void loop()
{
  digitalWrite(trigPin, LOW);
  delay(10);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds (10);
  digitalWrite(trigPin, LOW);
  pulse_echo= pulseIn (echoPin, HIGH);
  distance = (pulse_echo /2.0) / 29.0;
if (distance >= 50 ) {
  pos = 45;
  servo1.write(pos);
  servo2.write(pos);
  Serial.print(distance);
  Serial.println("   cm");
 }
if (distance < 50 ) {
  pos = 0;
  servo1.write(pos);
  servo2.write(pos);
  Serial.print(distance);
  Serial.println("   cm");
 }
 if (digitalRead(sw1)==LOW){
   
  x = 45;
  servo1.write(x);
  servo2.write(x);
  delay(500);
  x = 0;
  Serial.print(distance);
  Serial.println("   cm");
 }




 
}