/*
 * This ESP32 code is created by esp32io.com
 *
 * This ESP32 code is released in the public domain
 *
 * For more detail (instruction and wiring diagram), visit https://esp32io.com/tutorials/esp32-servo-motor
 */

#include <ESP32Servo.h>

int p1 = 26; // ESP32 pin GIOP26 connected to servo motor
int p2 = 25;
int p3 = 23;
int p4 = 22;
int p5 = 21;
int p6 = 19;


Servo s1;
Servo s2;
Servo s3;
Servo s4;
Servo s5;
Servo s6;



void setup() {
  s1.attach(p1);
  s2.attach(p2);
  s2.attach(p3);
  s2.attach(p4);
  s2.attach(p5);
  s2.attach(p6);
}

void loop() {
  // rotates from 0 degrees to 180 degrees
  for (int pos = 0; pos <= 180; pos += 1) {
    // in steps of 1 degree
    s1.write(pos);
    s2.write(pos);
    s3.write(pos);
    s4.write(pos);
    s5.write(pos);
    s6.write(pos);

    delay(15); // waits 15ms to reach the position
  }

  // rotates from 180 degrees to 0 degrees
  for (int pos = 180; pos >= 0; pos -= 1) {
    s1.write(pos);
    s2.write(pos);
    s3.write(pos);
    s4.write(pos);
    s5.write(pos);
    s6.write(pos);
    delay(15); // waits 15ms to reach the position
  }
}