#include "IRdetector.h"

#include "Led.h"

int Pint_IR_out = 10;

int Pint_IR_inECO = 9;

int LEDaprop = 12;

int LEDmig = 8;

int LEDlluny = 6;

double DISTANCIA;

IRD IRDe(Pint_IR_out, Pint_IR_inECO);

Led Led_a(LEDaprop);

Led Led_m(LEDmig);

Led Led_l(LEDlluny);


 void setup() {
  
  pinMode(Pint_IR_out, OUTPUT);

  pinMode(Pint_IR_inECO, INPUT);

  pinMode(LEDaprop, OUTPUT);  
  
  pinMode(LEDmig, OUTPUT);  
  
  pinMode(LEDlluny, OUTPUT);

  Serial.begin(9600);
  
}

void loop() {

  DISTANCIA = IRDe.mesura();

  if ((DISTANCIA <= 10) && (DISTANCIA >= 0)){
   
    Led_a.encen(); 
    Led_m.apaga();
    Led_l.apaga();
  
  }
  
  else if ((DISTANCIA <= 64.21) && (DISTANCIA >= 10)){
  
     Led_m.encen();
   
     Led_a.apaga();
   
     Led_l.apaga();
  } 
  
  else if ((DISTANCIA <= 100) && (DISTANCIA >= 64.21)){

    Led_l.encen(); 
    
    Led_a.apaga();
    
    Led_m.apaga(); 
    
  } 
  
  else {

    Serial.print("Fora de rang, distancia mesurada: ");

    Led_l.apaga();

    Led_a.apaga();

    Led_m.apaga();

  }
  
  Serial.println(DISTANCIA);
}