Display Ultrasonic Sensor and Servo

1#include<LiquidCrystal.h>
2#include<Servo.h>
3
4int trigPin=2;
5int  echoPin=3;
6int distance;
7
8 const int rs = 12, en = 11, d4 = 7, d5 = 6,  d6 = 5, d7 = 4;
9LiquidCrystal lcd(rs, en, d4, d5, d6, d7);
10
11long duration;
12Servo  servo;
13
14void setup()
15{
16  pinMode(trigPin, OUTPUT);
17  pinMode(echoPin,  INPUT);
18  Serial.begin(9600);
19  servo.attach(9);
20  lcd.begin(16, 2);
21}
22
23void  loop()
24{
25  for(int i=15;i<=165;i++)
26  {
27    servo.write(i);
28    delay(200);
29    printOut();
30  }
31  for(int i=165;i>15;i--)
32  {
33    servo.write(i);
34    delay(200);  
35   printOut(); 
36  }
37}
38
39int calculateDistance()
40{
41  digitalWrite(trigPin,LOW);
42  delayMicroseconds(2);
43  digitalWrite(trigPin,HIGH);
44  delayMicroseconds(10);
45  digitalWrite(trigPin,LOW);
46  
47  duration=pulseIn(echoPin,HIGH);
48  distance=duration*0.034/2;
49  return distance;
50}  
51
52void printOut()
53  {
54  lcd.clear();
55    lcd.setCursor(0, 0); 
56    lcd.print("Servo Pos: ");
57    lcd.print(servo.read());
58    lcd.setCursor(0, 1); 
59    lcd.print("Distance:  ");
60    lcd.print(calculateDistance());
61 }

1#include<LiquidCrystal.h>
2#include<Servo.h>
3
4int trigPin=2;
5int
6  echoPin=3;
7int distance;
8
9 const int rs = 12, en = 11, d4 = 7, d5 = 6,
10  d6 = 5, d7 = 4;
11LiquidCrystal lcd(rs, en, d4, d5, d6, d7);
12
13long duration;
14Servo
15  servo;
16
17void setup()
18{
19  pinMode(trigPin, OUTPUT);
20  pinMode(echoPin,
21  INPUT);
22  Serial.begin(9600);
23  servo.attach(9);
24  lcd.begin(16, 2);
25}
26
27void
28  loop()
29{
30  for(int i=15;i<=165;i++)
31  {
32    servo.write(i);
33    delay(200);
34
35    printOut();
36  }
37  for(int i=165;i>15;i--)
38  {
39    servo.write(i);
40
41    delay(200);  
42   printOut(); 
43  }
44}
45
46int calculateDistance()
47{
48
49  digitalWrite(trigPin,LOW);
50  delayMicroseconds(2);
51  digitalWrite(trigPin,HIGH);
52
53  delayMicroseconds(10);
54  digitalWrite(trigPin,LOW);
55  
56  duration=pulseIn(echoPin,HIGH);
57
58  distance=duration*0.034/2;
59  return distance;
60}  
61
62void printOut()
63
64  {
65  lcd.clear();
66    lcd.setCursor(0, 0); 
67    lcd.print("Servo Pos: ");
68
69    lcd.print(servo.read());
70    lcd.setCursor(0, 1); 
71    lcd.print("Distance:
72  ");
73    lcd.print(calculateDistance());
74 }