int servoPin1 = 14;
int servoPin2 = 15;
int buttonPin1 = 22;
int buttonPin2 = 21;
int buttonPin3 = 20;
int ledPin1 = 27;
int ledPin2 = 26;
int potPin = A2;

#define DIR_PIN1 2
#define STEP_PIN1 3
#define DIR_PIN2 9
#define STEP_PIN2 10

const unsigned long DEBOUNCE_MS = 25;

unsigned long t1=0, t2=0, t3=0;
int prev1 = HIGH, prev2 = HIGH, prev3 = HIGH;

void setup() {
  // put your setup code here, to run once:
  Serial1.begin(115200);
  pinMode(buttonPin1, INPUT);
  pinMode(buttonPin2, INPUT);
  pinMode(buttonPin3, INPUT);
  pinMode(servoPin1, OUTPUT);
  pinMode(servoPin2, OUTPUT);
  pinMode(STEP_PIN1, OUTPUT);
  pinMode(DIR_PIN1, OUTPUT);
  pinMode(STEP_PIN2, OUTPUT);
  pinMode(DIR_PIN2, OUTPUT);
  pinMode(ledPin1, OUTPUT);
  pinMode(ledPin2, OUTPUT);
  digitalWrite(STEP_PIN1, LOW);
  digitalWrite(STEP_PIN2, LOW);

}

void loop() {
  // put your main code here, to run repeatedly:
  

  // code for buttons
  // delay(10);
  // int buttonState1 = digitalRead(buttonPin1);
  // int buttonState2 = digitalRead(buttonPin2);
  // int buttonState3 = digitalRead(buttonPin3);

  // // check if the pushbutton is pressed. If it is, the buttonState is HIGH:
  // if (buttonState1 == HIGH) {
  //   // turn LED on:
  //   Serial1.println("Button 1 pressed");
  //   digitalWrite(ledPin1, HIGH);
  // } else {
  //   // turn LED off:
  //   digitalWrite(ledPin1, LOW);
  // }

  // if (buttonState2 == HIGH) {
  //   // turn LED on:
  //   Serial1.println("Button 2 pressed");
  //   digitalWrite(ledPin1, HIGH);
  // } else {
  //   // turn LED off:
  //   digitalWrite(ledPin1, LOW);
  // }

  // if (buttonState3 == HIGH) {
  //   // turn LED on:
  //   Serial1.println("Button 3 pressed");
  //   digitalWrite(ledPin1, HIGH);
  // } else {
  //   // turn LED off:
  //   digitalWrite(ledPin1, LOW);
  // }

  // potentiometer code
  // int potValue = analogRead(potPin);  // Read value (0–1023)
  // Serial1.println(potValue);           // Print it to Serial Monitor
  // delay(100);
  
  // code for Servos

  // for (int x = 0; x < 100; ++x) {
  //   digitalWrite(servoPin1, HIGH);
  //   digitalWrite(servoPin2, HIGH);
  //   delayMicroseconds(1000);
  //   digitalWrite(servoPin1, LOW);
  //   digitalWrite(servoPin2, LOW);
  //   delayMicroseconds(19000);
  // }


  // for (int x = 0; x < 100; ++x) {
  //   digitalWrite(servoPin1, HIGH);
  //   digitalWrite(servoPin2, HIGH);
  //   delayMicroseconds(2000);
  //   digitalWrite(servoPin1, LOW);
  //   digitalWrite(servoPin2, LOW);
  //   delayMicroseconds(18000);
  // }
  
  // Code for Steppers

  // digitalWrite(DIR_PIN1, HIGH);
  // for (int i = 0; i < 200; i++) {
  //   digitalWrite(STEP_PIN1, HIGH);
  //   digitalWrite(STEP_PIN1, LOW);
  //   delay(5); // 5 ms * 200 = 1 second
  // }

  // delay(500); // Wait half a second

  // // Move 200 steps (one rotation) CCW over 400 millis
  // digitalWrite(DIR_PIN1, LOW); 
  // for (int i = 0; i < 200; i++) {
  //   digitalWrite(STEP_PIN1, HIGH);
  //   digitalWrite(STEP_PIN1, LOW);
  //   delay(2); // 2 ms * 200 = 0.4 seconds
  // }

  // delay(1000); // Wait another second


  // digitalWrite(DIR_PIN2, HIGH);
  // for (int i = 0; i < 200; i++) {
  //   digitalWrite(STEP_PIN2, HIGH);
  //   digitalWrite(STEP_PIN2, LOW);
  //   delay(5); // 5 ms * 200 = 1 second
  // }

  // delay(500); // Wait half a second

  // // Move 200 steps (one rotation) CCW over 400 millis
  // digitalWrite(DIR_PIN2, LOW); 
  // for (int i = 0; i < 200; i++) {
  //   digitalWrite(STEP_PIN2, HIGH);
  //   digitalWrite(STEP_PIN2, LOW);
  //   delay(2); // 2 ms * 200 = 0.4 seconds
  // }

  // delay(1000); // Wait another second
  

}