#include <NewPing.h>
#include <IRremote.h>

int wartosc = 0x0;
unsigned long previousMillis = 0;
IRsend irsend;
const long interval1 = 2000;
const long interval2 = 1000;
#define trig 12
#define echo 11
#define max_dyst 30
#define r 6
#define y 5
#define g 4

NewPing sonar(trig,echo,max_dyst);

void setup() {
  Serial.begin(9600);
  pinMode(trig,OUTPUT);
  pinMode(echo,INPUT);
}

void loop() {
  unsigned long currentMillis = millis();
  int odleglosc = sonar.convert_cm(sonar.ping_median());
  if(currentMillis - previousMillis >= interval1){
    if (wartosc !=0){
      irsend.sendRC5(wartosc, 12);
      Serial.println("Wysłano!");
      previousMillis = currentMillis;
    }
  }


  if (odleglosc<10 && odleglosc!=0) {
     digitalWrite(g,LOW);
     digitalWrite(y,LOW);
     digitalWrite(r,HIGH);
     Serial.println("wstecz");
//     irsend.sendRC5(0x61, 12);
     wartosc = 0x61;

  }
  else if (odleglosc>20) {
     digitalWrite(g,HIGH);
     digitalWrite(y,LOW);
     digitalWrite(r,LOW);
     Serial.println("do przodu");
//     irsend.sendRC5(0x60, 12);
     wartosc = 0x60;
  }
  else if (odleglosc>=10 && odleglosc<=20){
     digitalWrite(g,LOW);
     digitalWrite(y,HIGH);
     digitalWrite(r,LOW);
     Serial.println("nic");
     wartosc = 0;
  }
  else {
    Serial.println("stara wartosc");
    Serial.println(wartosc);
 //   irsend.sendRC5(wartosc,12);
  }
  delay(100);


}