#include <AccelStepper.h>

#define pul1 17
#define pul2 0
#define dir1 16
#define dir2 4
int angle = 200;
int angle1 = 400;

AccelStepper stepper(1,pul1,dir1);
AccelStepper stepper2(1,pul2,dir2);


void setup() {
  
  stepper.setMaxSpeed(200);  // Maximum speed (steps per second)
  stepper.setAcceleration(500);  // Acceleration (steps per second^2)

  // stepper2.moveTo(0); 
  stepper2.setMaxSpeed(400);  // Maximum speed (steps per second)
  stepper2.setAcceleration(500);  // Acceleration (steps per second^2)

  
}

void loop() {
  int positions[2] = {0,0};
      if(stepper.distanceToGo() == 0){
        delay(2000);
        static int currentPosIndex = 0;
        static int targetPosIndex = 0;
        static int backPosIndex = 1;
        positions[targetPosIndex] += angle;
        positions[backPosIndex] -= angle;

        stepper.move(positions[currentPosIndex]);
        // currentPosIndex = (currentPosIndex + 1) % (sizeof(positions) / sizeof(positions[0]));

        
      }
      stepper.run();
      // stepper.runSpeed();

  // int positions1[2] = {0,0};
  //     if(stepper2.distanceToGo() == 0){
  //       delay(2000);
  //       static int currentPosIndex1 = 0;
  //       static int targetPosIndex1 = 0;
  //       static int backPosIndex1 = 1;
  //       positions1[targetPosIndex1] += angle1;
  //       positions1[backPosIndex1] -= angle1;

  //       stepper2.move(positions1[currentPosIndex1]);
  //       currentPosIndex1 = (currentPosIndex1 + 1) % (sizeof(positions1) / sizeof(positions1[0]));

        
  //     }
  //     stepper2.run();
  //     // stepper2.runSpeed();
}