#include <ESP32Servo.h>
#define TIME_STEP 20 // in ms
// These are all GPIO pins on the ESP32
// Recommended pins include 2,4,12-19,21-23,25-27,32-33
#define PIN_SERVO_1 12
#define PIN_SERVO_2 14
// create four servo objects
Servo servo1;
Servo servo2;
// Published values for SG90 servos; adjust if needed
int minUs = 500;
int maxUs = 2400;
int pos = 0; // position in degrees
void setup() {
Serial.begin(115200);
Serial.println("=============================================================================");
Serial.println("Controll Servo");
Serial.println("=============================================================================");
servo1.attach(PIN_SERVO_1, minUs, maxUs);
servo2.attach(PIN_SERVO_2, minUs, maxUs);
}
void loop() {
for (pos = 0; pos <= 180; pos++) { // sweep from 0 degrees to 180 degrees
servo1.write(pos);
delay(TIME_STEP);
}
for (pos = 180; pos >= 0; pos--) { // sweep from 180 degrees to 0 degrees
servo2.write(pos);
delay(TIME_STEP);
}
}
Loading
esp32-devkit-c-v4
esp32-devkit-c-v4
servo1:GND
servo1:V+
servo1:PWM
servo2:GND
servo2:V+
servo2:PWM