#include <ESP32Servo.h>
Servo brazoR;
Servo brazoL;
Servo cuello;
Servo piernaR;
Servo piernaL;
Servo ruedaR;
Servo ruedaL;

int pinPiernaR = 2;
int pinRuedaR = 4;
int pinBrazoR = 5;
int pinCuello = 18;
int pinBrazoL = 19;
int pinPiernaL = 21;
int pinRuedaL = 22;

void setup() {
  piernaR.attach(pinPiernaR);
  ruedaR.attach(pinRuedaR);
  brazoR.attach(pinBrazoR);
  cuello.attach(pinCuello);
  brazoL.attach(pinBrazoL);
  piernaL.attach(pinPiernaL);
  ruedaL.attach(pinRuedaL);
}


void loop() {
  probarServo( piernaR );
  probarServo( ruedaR );
  probarServo( brazoR );
  probarServo( cuello );
  probarServo( brazoL );
  probarServo( piernaL );
  probarServo( ruedaL );
}

void probarServo( Servo pinServo ) {
  for ( int i = 0; i <= 180; i++) {
    pinServo.write(i);
    delay(5);
  }
  for ( int i = 180; i >= 0; i--) {
    pinServo.write(i);
    delay(5);
  }
  delay(500);
}