A.T.M (Anti Transmission Mechanism)

1#include<Servo.h>
2int trigger=9;
3int sensor=0;
4int echo=10;
5
6Servo  servo1;
7Servo servo2;
8Servo servo3;
9Servo servo4;
10Servo servo5;
11
12long  calibration (int trigger,int echo){
13  pinMode(trigger,OUTPUT); 
14  digitalWrite(trigger,LOW);
15  delayMicroseconds(2);
16  digitalWrite(trigger,HIGH);
17  delayMicroseconds(10);
18  digitalWrite(trigger,LOW);
19   
20  
21pinMode(trigger, INPUT);
22  return  pulseIn(echo,HIGH);
23}
24 
25void setup(){
26  servo1.attach(2);
27  servo2.attach(3);
28  servo3.attach(4);
29  servo4.attach(5);
30  servo5.attach(6);
31    
32    }
33void  loop()
34{
35sensor = 0.01723 * calibration(9,10);
36  Serial.println(sensor);
37  delay(500);
38if (sensor < 100 && sensor > 90){
39    servo1.write(90);
40    delay(400);
41    servo1.write(0);
42  }
43if (sensor < 90 && sensor > 80){
44    servo2.write(90);
45    delay(400);
46  servo2.write(0);
47  }
48if (sensor  < 80 && sensor > 70){
49    servo3.write(90);
50    delay(400);
51  servo3.write(0);
52  }
53if (sensor < 70 && sensor > 60){
54    servo4.write(90);
55    delay(400);
56  servo4.write(0);
57  }
58
59  if (sensor < 60 && sensor > 50){
60    servo5.write(90);
61    delay(400);
62    servo5.write(0);
63  }
64}