#include <ESP32Servo.h>
// 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
#define POTI_POS_START 35
#define POTI_POS_END 32
#define POTI_SPEED 25
// create four servo objects
Servo servo1;
Servo servo2;
// Published values for SG90 servos; adjust if needed
int minUs = 500;
int maxUs = 2400;
int pos_start;
int pos_end;
int speed;
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() {
pos_start = int (analogRead(POTI_POS_START) >> 6);
pos_end = int (180 - (analogRead(POTI_POS_END) >> 6));
speed = int (1 + (analogRead(POTI_SPEED) >> 7));
Serial.println("Start: " + String(pos_start) + " End: " + String(pos_end) + " Speed: " + String(speed));
for (pos = pos_start; pos <= pos_end; pos++) { // sweep from 0 degrees to 180 degrees
servo1.write(pos);
servo2.write(180 - pos);
delay(speed);
}
}
esp:0
esp:2
esp:4
esp:5
esp:12
esp:13
esp:14
esp:15
esp:16
esp:17
esp:18
esp:19
esp:21
esp:22
esp:23
esp:25
esp:26
esp:27
esp:32
esp:33
esp:34
esp:35
esp:3V3
esp:EN
esp:VP
esp:VN
esp:GND.1
esp:D2
esp:D3
esp:CMD
esp:5V
esp:GND.2
esp:TX
esp:RX
esp:GND.3
esp:D1
esp:D0
esp:CLK
servo1:GND
servo1:V+
servo1:PWM
servo2:GND
servo2:V+
servo2:PWM
pot4:VCC
pot4:SIG
pot4:GND
pot1:VCC
pot1:SIG
pot1:GND
pot2:VCC
pot2:SIG
pot2:GND