Sistema de Radar con MicroControlador Arduino

He diseñado un Sistema de Radar que permite a los docentes y estudiantes entender el funcionamiento de los radares, sonares y eco localizadores. El sistema se fundamenta en el uso de los micros controladores. El  funcionamiento del sistema y los  respectivos códigos se pueden observar en el siguiente vídeo…..  

Código para la programación del Arduino

#include <Servo.h>.

#include <Adafruit_GFX.h>    // Core graphics library

#include <Adafruit_TFTLCD.h> // Hardware-specific library

#include <TouchScreen.h>

#define LCD_CS A3 // Chip Select goes to Analog 3

#define LCD_CD A2 // Command/Data goes to Analog 2

#define LCD_WR A1 // LCD Write goes to Analog 1

#define LCD_RD A0 // LCD Read goes to Analog 0

#define LCD_RESET A4 // Can alternately just connect to Arduino's reset pin

#define YP A3  // must be an analog pin, use "An" notation!

#define XM A2  // must be an analog pin, use "An" notation!

#define YM 9   // can be a digital pin

#define XP 8   // can be a digital pin

#define TS_MINX 150

#define TS_MINY 120

#define TS_MAXX 920

#define TS_MAXY 940

#define MINPRESSURE 10

#define MAXPRESSURE 1000

TouchScreen ts = TouchScreen(XP, YP, XM, YM, 300);

// Assign human-readable names to some common 16-bit color values:

#define  BLACK   0x0000

#define BLUE    0x001F

#define RED     0xF800

#define GREEN   0x07E0

#define CYAN    0x07FF

#define MAGENTA 0xF81F

#define YELLOW  0xFFE0

#define WHITE   0xFFFF

Adafruit_TFTLCD tft(LCD_CS, LCD_CD, LCD_WR, LCD_RD, LCD_RESET);

Servo myServo; // Creates a servo object for controlling the servo motor

const int trigPin = 26;

const int echoPin = 24;

// Variables for the duration and the distance

long duration;

int distance,xpos,ypos,iOld;

float sx = 0, sy = 1, mx = 1, my = 0, hx = -1, hy = 0;

int16_t x0 = 0, x1 = 0, yy0 = 0, yy1 = 0, x00 = 0, yy00 = 0,ang,iTemp;

String tmp="";

void setup() {

  Serial.begin(9600);

   tft.reset();

  uint16_t identifier = tft.readID();

  tft.begin(identifier);

  tft.setRotation(0);

  tft.fillScreen(BLACK);

  tft.fillScreen(RED);

  tft.fillScreen(GREEN);

  tft.fillScreen(BLUE);

  tft.fillScreen(BLACK);

  delay(100);

  //tft.setRotation(0);

 // put your setup code here, to run once:

 myServo.attach(52); // Defines on which pin is the servo motor attached 

pinMode(trigPin, OUTPUT); // Sets the trigPin as an Output

  pinMode(echoPin, INPUT); // Sets the echoPin as an Input

  

  tft.setRotation(1);

  radar();

}

void loop() {

   

  // put your main code here, to run repeatedly:

 for(int i=15;i<=165;i=i+2)

 {  

  myServo.write(i);

   //angulo(iOld,BLACK);

   if (distance>30)

    angulo(i,GREEN);

    else

    angulo(i,RED);

   tmp=i;

 tft.fillRect(125,141,40,16,BLACK);

  texto( tmp,125,141,2,GREEN);  

  iOld=i;

  //delay(10);

   distance = calculateDistance();// Calls a function for calculating the distance measured by the Ultrasonic sensor for each degree

   Serial.print(i); // Sends the current degree into the Serial Port

  Serial.print(","); // Sends addition character right next to the previous value needed later in the Processing IDE for indexing

  Serial.print(distance); // Sends the distance value into the Serial Port

  Serial.print("."); // Sends addition character right next to the previous value needed later in the Processing IDE for indexing

  tmp=distance;

 tft.fillRect(125,161,40,16,BLACK);

  texto( tmp,125,161,2,GREEN);  

 }

radar();

 for(int i=165;i>15;i=i-2){  

  myServo.write(i);

  //angulo(iOld,BLACK);

   if (distance>30)

    angulo(i,GREEN);

    else

    angulo(i,RED);

   tmp=i;

 tft.fillRect(125,141,40,16,BLACK);

  texto( tmp,125,141,2,GREEN);  

  iOld=i;

  //delay(10);

   distance = calculateDistance();// Calls a function for calculating the distance measured by the Ultrasonic sensor for each degree

  Serial.print(i); // Sends the current degree into the Serial Port

  Serial.print(","); // Sends addition character right next to the previous value needed later in the Processing IDE for indexing

  Serial.print(distance); // Sends the distance value into the Serial Port

  Serial.print("."); // Sends addition character right next to the previous value needed later in the Processing IDE for indexing

  tmp=distance;

 tft.fillRect(125,161,40,16,BLACK);

  texto( tmp,125,161,2,GREEN);  

}

radar();

}

int calculateDistance(){ 

  

  digitalWrite(trigPin, LOW); 

  delayMicroseconds(2);

  // Sets the trigPin on HIGH state for 10 micro seconds

  digitalWrite(trigPin, HIGH); 

  delayMicroseconds(10);

  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH); // Reads the echoPin, returns the sound wave travel time in microseconds

  distance= duration*0.034/2;

  return distance;

}

void radar()

{

   

   tft.fillRect(0,0,tft.width(),tft.height(),BLACK);

   texto( "Radar Posicion",75,125,2,WHITE);

   texto( "Ang=",75,141,2,GREEN);

   texto( "Dis=",75,161,2,YELLOW);

   

   xpos = tft.width() / 2; 

   ypos = tft.height() / 2; 

  tft.drawCircle(xpos, ypos, 120, YELLOW);

  for ( ang=0;ang<=180;ang=ang+30)

  {

  

  angulo ( ang, BLUE);

}

}

void texto(String texto,int x,int y,int Size,int color)

{

    tft.setTextColor(color);

     tft.setCursor(x, y);

     tft.setTextSize(Size);

     tft.println(texto);

}

void angulo (int16_t ang, int color)

{

sx = cos(( - ang) * 0.0174532925);

    sy = sin(( - ang) * 0.0174532925);

    x0 = sx * 114 + xpos;

    yy0 = sy * 114 + 120;

    x1 = sx * 100 + xpos;

    yy1 = sy * 100 + 120;

    tft.drawLine(x0, yy0, xpos, ypos, color);

   

}

void coordenadas()

{

  for ( ang=0;ang<=180;ang=ang+30)

  {

  

  angulo ( ang,BLUE);

}

  

}