#include "sensorHandler.h"
#include <ESP32Servo.h>


#define sensorIR_1 12
#define sensorIR_2 13
#define sensorIR_3 14
#define sensorIR_4 15
#define SERVO_PIN 18

IRsensor IRsensor1(sensorIR_1);
IRsensor IRsensor2(sensorIR_2);
IRsensor IRsensor3(sensorIR_3);
IRsensor IRsensor4(sensorIR_4);
Servo servo;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);

  IRsensor1.begin();
  servo.attach(SERVO_PIN);
  servo.write(90);

  Serial.println("Hello, ESP32-S2!");
}

void loop() {
  // put your main code here, to run repeatedly:

  Serial.printf("IR State1: %d\n", IRsensor1.getRead());
  Serial.printf("IR State2: %d\n", IRsensor2.getRead());
  Serial.printf("IR State3: %d\n", IRsensor3.getRead());
  Serial.printf("IR State4: %d\n", IRsensor4.getRead());
  //Serial.printf("Pos Servo: %d\n", servo.getRead());

  //if (IRsensor1 == LOW)
   //{
     servo.write(90);
   //}
   //else(){
     servo.write(0);
  // }


  delay(300); // this speeds up the simulation
}