RADAR

Realizado por: Aitor Manga Sosa, Jesús Medina Ruiz y Benjamín Ruiz-Mateos Fernández

PROGRAMACIÓN:

PROCESSING

1. 
   import processing.serial.*;
   

2. 
   

3. Serial mipuerto;
   

4. String serialAngulo;
   

5. String serialDistancia;
   

6. String serialDatos;
   

7. float objetoDistancia;
   

8. int radarAngulo, radarDistancia;
   

9. int index=0;
   

10. 
    

11. void setup(){
    

12.   size (1280, 720);
    

13. 
    

14.   mipuerto = new Serial(this, Serial.list()[0], 9600);
    

15. 
    

16.   mipuerto.bufferUntil('#');
    

17.   frameRate(60);
    

18. }
    

19. 
    

20. void draw(){
    

21.   noStroke();
    

22. 
    

23.   fill(0,4);
    

24.   rect(0, 0, 1280, 720);
    

25.   fill(10,255,10);
    

26. 
    

27.   //Radar Arcos y líneas 
    

28.   pushMatrix(); 
    

29.   translate(640,666);
    

30.   noFill();
    

31.   strokeWeight(2);
    

32.   stroke(10,255,10); 
    

33.   arc(0,0,1200,1200,PI,TWO_PI);
    

34.   arc(0,0,934,934,PI,TWO_PI);
    

35.   arc(0,0,666,666,PI,TWO_PI);
    

36.   arc(0,0,400,400,PI,TWO_PI);
    

37.   strokeWeight(4);
    

38.   line(-640,0,640,0);
    

39.   line(0,0,-554,-320);
    

40.   line(0,0,-320,-554);
    

41.   line(0,0,0,-640);
    

42.   line(0,0,320,-554);
    

43.   line(0,0,554,-320); 
    

44.   popMatrix();
    

45. 
    

46. 
    

47.   // Líneas del radar
    

48.   pushMatrix(); 
    

49.   strokeWeight(5);
    

50.   stroke(10,255,10); // color verde
    

51.   translate(640,666);
    

52.   line(0,0,640*cos(radians(radarAngulo)),-640*sin(radians(radarAngulo))); 
    

53.   popMatrix();
    

54. 
    

55.   // Objeto detectado, líneas de color rojo
    

56.   pushMatrix(); 
    

57.   translate(640,666);
    

58.   strokeWeight(5);
    

59.   stroke(255,10,10); // color rojo
    

60.   objetoDistancia = radarDistancia*15;
    

61. 
    

62.   if(radarDistancia<40){  // si la distancia es menos de 40 cm
    

    1. 
       line(objetoDistancia*cos(radians(radarAngulo)),-objetoDistancia*sin(radians(radarAngulo)),633*cos(radians(radarAngulo)),-633*sin(radians(radarAngulo)));
       

64.   } 
    

65.   popMatrix();
    

66. }
    

67. 
    

68. void serialEvent(Serial mipuerto){
    

69.   serialDatos = mipuerto.readStringUntil('#');
    

70.   serialDatos = serialDatos.substring(0,serialDatos.length()-1);
    

71. 
    

72.   index = serialDatos.indexOf("*");
    

73. 
    

74.   serialAngulo= serialDatos.substring(0, index);
    

75.   serialDistancia= serialDatos.substring(index+1, serialDatos.length());
    

76. 
    

77.   radarAngulo = int(serialAngulo);
    

78.   radarDistancia = int(serialDistancia);
    

79. }
    
    

ARDUINO

1. 
   
   

2. #include <Servo.h>
   

3. 
   

4. const int trigPin = 10;
   

5. const int echoPin = 11;
   

6. 
   

7. long duracion;
   

8. int distanciaCM;
   

9. 
   

10. Servo radarServo;
    

11. 
    

12. void setup(){
    

13. pinMode(trigPin, OUTPUT);
    

14. pinMode(echoPin, INPUT);
    

15. Serial.begin(9600);
    

16. radarServo.attach(12);
    

17. }
    

18. 
    

19. void loop(){
    

20. for(int i=0;i<=180;i++){
    

21.   radarServo.write(i);
    

22.   delay(50);
    

23.  
    

24.   digitalWrite(trigPin, LOW);
    

25.   delayMicroseconds(4);
    

26.   digitalWrite(trigPin, HIGH);
    

27.   delayMicroseconds(10);
    

28.   digitalWrite(trigPin, LOW);
    

29.   duracion = pulseIn(echoPin, HIGH);
    

30.   distanciaCM = duracion*0.034/2;
    

31.  
    

32.   Serial.print(i);
    

33.   Serial.print("*");
    

34.   Serial.print(distanciaCM);
    

35.   Serial.print("#");
    

36. }
    

37.   for(int i=180;i>=0;i--){
    

38.   radarServo.write(i);
    

39.   delay(50);
    

40.   digitalWrite(trigPin, LOW);
    

41.   delayMicroseconds(4);
    

42.   digitalWrite(trigPin, HIGH);
    

43.   delayMicroseconds(10);
    

44.   digitalWrite(trigPin, LOW);
    

45.   duracion = pulseIn(echoPin, HIGH);
    

46.   distanciaCM = duracion*0.034/2;
    

47.  
    

48.   Serial.print(i);
    

49.   Serial.print("*");
    

50.   Serial.print(distanciaCM);
    

51.   Serial.print("#");
    

52. }
    

53. }