#include <Servo.h>
// Create servo objects and constants for pot pins
Servo servo_1;
Servo servo_2;

const int  A_clock= 12;
const int  A_antiClock= 11;
const int  B_clock= 10;
const int  B_antiClock= 9;


 int a_clock_push, a_anticlock_push, b_clock_push, b_anticlock_push;

void setup() {

  Serial.begin(115200);
  servo_1.attach(3);
  servo_2.attach(5);

  pinMode(A_clock, INPUT);
  pinMode(A_antiClock, INPUT);
  pinMode(B_clock, INPUT);
  pinMode(B_antiClock, INPUT);

  servo_1.write(90);
  servo_2.write(90);

}


void readPushButton(){

  a_clock_push = digitalRead(A_clock);
  a_anticlock_push = digitalRead(A_antiClock);
  b_clock_push = digitalRead(B_clock);
  b_anticlock_push = digitalRead(B_antiClock);

}

void printButtonValue(){
  Serial.print("Button 1 state : ");
  Serial.println(a_clock_push);
  Serial.print("Button 2 state : ");
  Serial.println(a_anticlock_push);
  Serial.print("Button 3 state : ");
  Serial.println(b_clock_push);
  Serial.print("Button 4 state : ");
  Serial.println(b_anticlock_push);

}

void loop() {

  // readPushButton();
  // printButtonValue();
 
  a_clock_push = digitalRead(A_clock);
  a_anticlock_push = digitalRead(A_antiClock);
  b_clock_push = digitalRead(B_clock);
  b_anticlock_push = digitalRead(B_antiClock);


  Serial.print("Button 1 state : ");
  Serial.println(a_clock_push);
  Serial.print("Button 2 state : ");
  Serial.println(a_anticlock_push);
  Serial.print("Button 3 state : ");
  Serial.println(b_clock_push);
  Serial.print("Button 4 state : ");
  Serial.println(b_anticlock_push);

  // int angle_1 = map(analog_value_1, 0, 1023, 0, 180);
  // int angle_2 = map(analog_value_2, 0, 1023, 0, 180);

  // // Set servo positions
  // servo_1.write(angle_1);
  // servo_2.write(angle_2);

  delay(100);

}