#include <DHT.h>
#include <ESP32Servo.h>
#include "SPI.h"
#include "Adafruit_GFX.h"
#include "Adafruit_ILI9341.h"

#define DHTPIN 19
#define DHTTYPE DHT22

#define ECHO_PIN1 26
#define TRIG_PIN1 27 

#define ECHO_PIN2 2
#define TRIG_PIN2 4 

#define ECHO_PIN3 21
#define TRIG_PIN3 22

#define ECHO_PIN4 23
#define TRIG_PIN4 25

#define LED 15
#define LED 17
#define LED 5

#define servoPin1 13
#define servoPin2 35
#define servoPin3 13
Servo servo1;
Servo servo2;
Servo servo3;

#define TFT_DC 32
#define TFT_CS 
Adafruit_ILI9341 tft = Adafruit_ILI9341(TFT_CS, TFT_DC);

ong duration1;
float distanceCm1;
long duration2;
float distanceCm2;
long duration3;
float distanceCm3;

void setup() {
  Serial.begin(115200); // Starts the serial communication
  pinMode(trigPin1, OUTPUT); // Sets the trigPin as an Output
  pinMode(echoPin1, INPUT); // Sets the echoPin as an Input
  pinMode(trigPin2, OUTPUT);
  pinMode(echoPin2, INPUT);
  pinMode(trigPin3, OUTPUT);
  pinMode(echoPin3, INPUT);
}

void loop() {
  // Sensor 1
  // Clears the trigPin
  digitalWrite(trigPin1, LOW);
  delayMicroseconds(2);
  // Sets the trigPin on HIGH state for 10 micro seconds
  digitalWrite(trigPin1, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin1, LOW);
  
  // Reads the echoPin, returns the sound wave travel time in microseconds
  duration1 = pulseIn(echoPin1, HIGH);
  
  // Calculate the distance
  distanceCm1 = duration1 * SOUND_SPEED/2;
  
  // Prints the distance in the Serial Monitor
  Serial.print("Distance 1 (cm): ");
  Serial.println(distanceCm1);
  
  delay(1000);

  // Sensor 2
  // Clears the trigPin
  digitalWrite(trigPin2, LOW);
  delayMicroseconds(2);
  // Sets the trigPin on HIGH state for 10 micro seconds
  digitalWrite(trigPin2, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin2, LOW);
  
  // Reads the echoPin, returns the sound wave travel time in microseconds
  duration2 = pulseIn(echoPin2, HIGH);
  
  // Calculate the distance
  distanceCm2 = duration2 * SOUND_SPEED/2;
  
  // Prints the distance in the Serial Monitor
  Serial.print("Distance 2 (cm): ");
  Serial.println(distanceCm2);
  
  delay(1000);

  // Sensor 3
  // Clears the trigPin
  digitalWrite(trigPin3, LOW);
  delayMicroseconds(2);
  // Sets the trigPin on HIGH state for 10 micro seconds
  digitalWrite(trigPin3, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin3, LOW);
  
  // Reads the echoPin, returns the sound wave travel time in microseconds
  duration3 = pulseIn(echoPin3, HIGH);
  
  // Calculate the distance
  distanceCm3 = duration3 * SOUND_SPEED/2;
  
  // Prints the distance in the Serial Monitor
  Serial.print("Distance 3 (cm): ");
  Serial.println(distanceCm3);
  
  delay(1000);
}