William Brito V-11786481 1 #include <Servo.

h>
2 Servo porton;
3 int trig=2;
4 int echo=3;
5 int tiempo;
6 int distancia;
7 int rojo=5;
8 int verde=6;
9 int ang;
10
11 void setup()
12 {
13 Serial.begin(9600);
14 pinMode(trig, OUTPUT);
15 pinMode(echo, INPUT);
16 porton.attach(4);
17 pinMode(rojo,OUTPUT);
18 pinMode(verde,OUTPUT);
19 }
20
21 void loop()
22 {
23 digitalWrite(trig, HIGH);
24 digitalWrite(trig, LOW);
25 tiempo=pulseIn(echo,HIGH);
26 distancia=tiempo/58.2;
27 Serial.println(distancia);
28 delay(10);
29
30 if(distancia<=30)
31 for(ang=0;ang<180;ang++)
32 {
33 porton.write(180);
34 delay(10);
35 digitalWrite(verde,HIGH);
36 digitalWrite(rojo,LOW);
37 }
38 if(distancia>30)
39 for(ang<=180;ang>0;ang--)
40 {
41 porton.write(0);
42 digitalWrite(verde,HIGH);
43 digitalWrite(rojo,LOW);
44 delay(10);
45 digitalWrite(verde,HIGH);
46 digitalWrite(rojo,LOW);
47 delay(10);
48 digitalWrite(verde,LOW);
49 digitalWrite(rojo,HIGH);
50 }
51 }