#include <Stepper.h>

int stepsPerRevolution = 2048;
int motSpeed = 50;
int dt = 500;
int state_fam = 0;

const byte button1Pin = 10;
const byte button2Pin = 11;
const byte button3Pin = 12;
const byte button4Pin = 13;

int motDir = 1;

Stepper myStepper1(stepsPerRevolution, 2, 4, 3, 5);
Stepper myStepper2(stepsPerRevolution, 6, 8, 7, 9);

void setup() {
  Serial.begin(115200);
  myStepper1.setSpeed(motSpeed);
  myStepper2.setSpeed(motSpeed);
  pinMode(button1Pin, INPUT_PULLUP);
  pinMode(button2Pin, INPUT_PULLUP);
  pinMode(button3Pin, INPUT_PULLUP);
  myStepper1.setSpeed(motSpeed);
  myStepper2.setSpeed(motSpeed);


  while (digitalRead(button2Pin) == HIGH) {
    myStepper2.step(motDir * -1);
    delay(50);
  }

}

byte runStepper1 = false;
byte runStepper2 = false;


void loop() {
  Serial.print("state: ");
  Serial.println(state_fam);

  switch (state_fam) {
    case 0:
      runStepper1 = true;
      myStepper1.step(motDir * 1);

      if (digitalRead(button1Pin) == LOW) {
        runStepper1 = false;
        state_fam = 1;
      }

      break;

    case 1:
      runStepper2 = true;
      myStepper2.step(motDir * 1);

      if (digitalRead(button2Pin) == LOW) {
        runStepper2 = false;
        state_fam = 2;
      }

      break;

    case 2:
      runStepper2 = true;
      myStepper2.step(motDir * -1);

      if (digitalRead(button3Pin) == LOW) {
        runStepper2 = false;
        state_fam = 0;
      }
      break;
  }
  delay(50);
}