Ultrasonic Smart Cap

1int TRIG_PIN_lft=12,TRIG_PIN_rgt=8,TRIG_PIN_frnt=10;
2int ECHO_PIN_lft=11,ECHO_PIN_rgt=13,ECHO_PIN_frnt=9;
3int  BAUD_RATE=9600;
4int buzzer=6,vbrmotor=5;
5
6void setup() {
7  pinMode(TRIG_PIN_lft,OUTPUT);
8  pinMode(TRIG_PIN_rgt,OUTPUT);
9  pinMode(TRIG_PIN_frnt,OUTPUT);
10  
11  pinMode(ECHO_PIN_lft,INPUT);
12  pinMode(ECHO_PIN_rgt,INPUT);
13  pinMode(ECHO_PIN_frnt,INPUT);
14
15  pinMode(buzzer,OUTPUT);
16  pinMode(vbrmotor,OUTPUT);
17  
18  Serial.begin(BAUD_RATE);
19}
20
21void  loop() {
22  //ultrasonic sensor left
23  digitalWrite(TRIG_PIN_lft,LOW);
24  delay(2);
25  digitalWrite(TRIG_PIN_lft,HIGH);
26  delay(10);
27  digitalWrite(TRIG_PIN_lft,LOW);
28  const unsigned long duration_lft= pulseIn(ECHO_PIN_lft,HIGH);
29 int distance_lft=  duration_lft/29/2;
30
31  
32    //ultrasonic sensor right
33   digitalWrite(TRIG_PIN_rgt,LOW);
34  delay(2);
35  digitalWrite(TRIG_PIN_rgt,HIGH);
36  delay(10);
37  digitalWrite(TRIG_PIN_rgt,LOW);
38  const unsigned long duration_rgt= pulseIn(ECHO_PIN_rgt,HIGH);
39 int distance_rgt=  duration_rgt/29/2;
40
41 
42  //ultrasonic sensor front
43  digitalWrite(TRIG_PIN_frnt,LOW);
44  delay(2);
45  digitalWrite(TRIG_PIN_frnt,HIGH);
46  delay(10);
47  digitalWrite(TRIG_PIN_frnt,LOW);
48  const unsigned long duration_frnt= pulseIn(ECHO_PIN_frnt,HIGH);
49 int distance_frnt=  duration_frnt/29/2;
50
51 Serial.print("left distance:  ");
52 Serial.print(distance_lft);
53  Serial.println(" ");
54  
55  Serial.print("right distance:  ");
56   Serial.print(distance_rgt);
57   Serial.println(" ");
58   
59    Serial.print("front distance:  ");
60     Serial.print(distance_frnt);
61      Serial.println(" ");
62
63 
64 if((distance_lft>=1  and distance_lft<=60) or (distance_rgt>=1 and distance_rgt<=60) or (distance_frnt>=1  and distance_frnt<=60))
65 {
66  digitalWrite(buzzer,HIGH);
67  digitalWrite(vbrmotor,HIGH);
68  } 
69  else
70  {
71   digitalWrite(buzzer,LOW);
72   digitalWrite(vbrmotor,LOW);
73  }
74
75 }
76