//Walter Lenigan - Fab Academy 2025

#include <Servo.h>

Servo S_1;  // create servo object to control a servo
Servo S_2;
Servo S_3;


char Accessories =0;


void setup() {
  Serial.begin(9600);
  pinMode(LED_BUILTIN, OUTPUT);

  S_1.attach(11);  
    S_1.write(0);
//      delay(1000);


  S_2.attach(10);  
    S_2.write(0);
//      delay(1000);


  S_3.attach(9);  
    S_3.write(0);
//      delay(1000);

    Serial.println("Hola Lenigan");


}

void loop() {

  digitalWrite(LED_BUILTIN, HIGH);   // turn the LED on (HIGH is the voltage level)
     delay(1000);                       // wait for a second
     digitalWrite(LED_BUILTIN, LOW);    // turn the LED off by making the voltage LOW
     delay(1000);                       // wait for a second

  if (Serial.available() > 0) {     //  It will only send data when the received data is greater than 0.  
    Accessories = Serial.read();
switch (Accessories) {
    case '1':  
      S_1.write(63);
      S_2.write(0);
      S_3.write(0);
      Serial.println("Servo #1 Open");
       break;

    case '2':  
      S_2.write(59);
      S_1.write(0);
      S_3.write(0);
      Serial.println("Servo #2 Open");
       break;

    case 'C':  
      S_3.write(65);
      S_1.write(0);
      S_2.write(0);
      Serial.println("Servo #3 Open");
       break;

    case '8':  
      S_1.write(0);
      S_2.write(0);
      S_3.write(0);
      Serial.println("Servos to ORIGIN");
       break;             }


  }
}