#include <Servo.h>

// Define pins for the two LEDs
const int LED1_PIN = 8;
const int LED2_PIN = 9;

// Define pins for the bar graph (A1 to A10)
const int BARGRAPH_PINS[] = {22, 23, 24, 25, 26, 27, 28, 29, 30, 31};
const int NUM_BARGRAPH_PINS = 10;

// Define pins for the servos
const int SERVO1_PIN = 2;
const int SERVO2_PIN = 3;

// Create servo objects
Servo servo1;
Servo servo2;

void setup() {
  // Initialize LED pins
  pinMode(LED1_PIN, OUTPUT);
  pinMode(LED2_PIN, OUTPUT);
  
  // Initialize bar graph pins
  for (int i = 0; i < NUM_BARGRAPH_PINS; i++) {
    pinMode(BARGRAPH_PINS[i], OUTPUT);
    digitalWrite(BARGRAPH_PINS[i], LOW); // Start with all segments off
  }
  
  // Attach servo objects to the corresponding pins
  servo1.attach(SERVO1_PIN);
  servo2.attach(SERVO2_PIN);
  
  // Set initial positions of the servos
  servo1.write(0);
  servo2.write(180);
  
  // Ensure all LEDs are off initially
  digitalWrite(LED1_PIN, LOW);
  digitalWrite(LED2_PIN, LOW);
}

void loop() {
  // Sweep Servo1 from 0° to 180° in increments of 10°
  for (int position1 = 0; position1 <= 180; position1 += 10) {
    servo1.write(position1);
    
    // Calculate corresponding position for Servo2 (moving in opposite direction)
    int position2 = 180 - position1;
    servo2.write(position2);
    
    // Control LED1 based on Servo1 position
    if (position1 <= 90) {
      digitalWrite(LED1_PIN, HIGH);
    } else {
      digitalWrite(LED1_PIN, LOW);
    }
    
    // Control LED2 based on Servo2 position
    if (position2 >= 90) {
      digitalWrite(LED2_PIN, HIGH);
    } else {
      digitalWrite(LED2_PIN, LOW);
    }
    
    // Control bar graph based on Servo1 position
    int numSegments = map(position1, 0, 180, 0, NUM_BARGRAPH_PINS);
    updateBarGraph(numSegments);
    
    // Pause for 2000 milliseconds (2 seconds)
    delay(2000);
  }
}

// Helper function to update the bar graph
void updateBarGraph(int numSegments) {
  for (int i = 0; i < NUM_BARGRAPH_PINS; i++) {
    if (i < numSegments) {
      digitalWrite(BARGRAPH_PINS[i], HIGH); // Light up this segment
    } else {
      digitalWrite(BARGRAPH_PINS[i], LOW); // Turn off this segment
    }
  }
}