// Servo Sweep example for the ESP32
#include <ESP32Servo.h>
int servoPin = 25;
int ledRed = 33;
int ledGreen = 32;
int analogPin = 26;
int val=0;
Servo servo;
void setup() {
Serial.begin(115200);
Serial.println("Start");
servo.attach(servoPin, 500, 2400);
pinMode(ledRed ,OUTPUT);
pinMode(ledGreen ,OUTPUT);
}
int pos = 0;
void loop() {
// debug value
for (pos = 0; pos <= 180; pos += 2) {
servo.write(pos);
digitalWrite(ledRed,HIGH);
val = analogRead(analogPin); // read the input pin
Serial.println(val/50);
delay(val/100); // speed
digitalWrite(ledGreen,LOW);
}
for (pos = 180; pos >= 0; pos -= 2) {
servo.write(pos);
digitalWrite(ledRed,LOW);
val = analogRead(analogPin); // read the input pin
Serial.println(val/50);
delay(val/100); // speed
digitalWrite(ledGreen,HIGH);
}
}