#include <AccelStepper.h>
#include <Servo.h> 

Servo myservo;  
int angulo;

const int dirPin = 2;
const int stepPin = 3;
const int dirPin2 = 4;
const int stepPin2 = 5;

const int fc_1 = 13;
const int fc_2 = 12;

int motordc= 11;

AccelStepper myStepper(AccelStepper::DRIVER, stepPin, dirPin);
AccelStepper myStepper2(AccelStepper::DRIVER, stepPin2, dirPin2);

void setup() {

  Serial.begin(9600);

  pinMode(fc_1, INPUT_PULLUP);
  pinMode(fc_2, INPUT_PULLUP);
  pinMode(motordc, OUTPUT);

  myservo.attach(10); 

  myStepper.setMaxSpeed(500);
  myStepper.setAcceleration(500);

  myStepper2.setMaxSpeed(500);
  myStepper2.setAcceleration(500);
}
void loop(){

  myStepper.setSpeed(500);
  myStepper.runSpeed();

  myStepper2.setSpeed(500);
  myStepper2.runSpeed();

  if(digitalRead(fc_1)==LOW){

    myStepper.stop();
    myStepper2.stop();

    myservo.write(0);
    delay(1000);

    digitalWrite(motordc,HIGH);
    delay(5000);

    digitalWrite(motordc,LOW);
    
    myStepper.setSpeed(-500);
    myStepper2.setSpeed(-500);

    myStepper.runSpeed();
    myStepper2.runSpeed();

    myStepper.moveTo(0);
    myStepper2.moveTo(0);

    myStepper.runToPosition();
    myStepper2.runToPosition();
    
    myStepper.stop();
    myStepper2.stop();
    delay(2000);

    myservo.write(90);
    delay(1000);

    myStepper.disableOutputs();
    myStepper2.disableOutputs();
  
  }
 }