#include <Arduino.h>
#include <Adafruit_ILI9341.h>

#define TFT_CS    15
#define TFT_DC    2
#define TFT_RST   -1

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

const int trigPin = 25;
const int echoPin = 26;

void setup() {
  Serial.begin(115200);
  tft.begin();
  tft.setRotation(4); // Ajuste a rotação da tela conforme necessário
  
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
}

void loop() {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  long duration = pulseIn(echoPin, HIGH);
  float distance_cm = duration * 0.034 / 2;
  float distance_m = distance_cm / 100.0; // Conversão para metros

  tft.fillScreen(ILI9341_BLACK);
  tft.setCursor(0, 0);
  tft.setTextSize(2);
  tft.setTextColor(ILI9341_ORANGE);
  tft.print("Distance: ");
  tft.print(distance_m, 2);
  tft.println(" m");
 
  delay(1000);
}