#include <Adafruit_GFX.h>
#include <Adafruit_ILI9341.h>

#define TFT_CS 10
#define TFT_RST 9
#define TFT_DC 8

#define trig 7
#define echo 6



Adafruit_ILI9341 TFT = Adafruit_ILI9341 (TFT_CS, TFT_DC, TFT_RST);




void setup() {
  TFT.begin();
  TFT.setRotation(0);
  TFT.fillScreen(ILI9341_BLACK);
  TFT.setTextSize(3);


  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);



}

void loop() {
  long razdalja_senzorja = get_dis();
  display(razdalja_senzorja);
  delay(500);

}

long get_dis() {
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  long duration = pulseIn(echo,HIGH);
  long razdalja = (duration * 0.0343) / 2; // pretvorba v centimetre
  return constrain(razdalja, 2, 200); // omejimo vrednosti od 2 do 40 cm
}

void display(long prikazana_razdalja) {
  TFT.fillScreen(ILI9341_BLACK);
  TFT.setCursor(50, 100);
  TFT.print("Razdalja : ");
  TFT.print(prikazana_razdalja);
  TFT.print(" cm");
}