#include <ESP32Servo.h>
#define PIN_IR 32
#define SERVO 0
#define PERIOD 2000
#define VCC 5
#define NBITS 12
#define BETA 3950
//timer
unsigned long startMillis;
unsigned long endMillis;
//servo
Servo myServo
//data
float sample
void setup() {
Serial.begin(115200);
pinMode(PIN_IR, INPUT);
pinMode(SERVO, OUTPUT);
myservo.attach(SERVO);
myservo.write(0);
Serial.println("START");
startMillis=millis();
}
void loop() {
endMillis = millis();
if(endMillis - startMillis >= PERIOD){
//Read sample
sample = (float)analogRead(PIN_IR);
//Send data to monitor
Serial.print("Infra Red ");
Serial.println(sample);
//update timer
startMillis=endMillis;
}
if (sample==1){
myservo.write(170);
}else {
myservo.write(0);
}
}