#include <Servo.h>

int var1, var2, var3;



Servo servo1;
Servo servo2;
Servo servo3;

char inputChars[20]; // Buffer to store the incoming string

void setup() {

  servo1.attach(3);
  servo2.attach(5);
  servo3.attach(6);
  // Start Serial communication
  Serial.begin(115200);

}

void loop() {
  if (Serial.available() > 0) {
    // Read the incoming string from Serial
    String inputString = Serial.readStringUntil('\n');  // Read the string until a newline character

    // Convert the input string to a char array
    inputString.toCharArray(inputChars, inputString.length() + 1);

    // Parse the string using strtok and convert to integers
    char* token = strtok(inputChars, ",");
    var1 = atoi(token);

    token = strtok(NULL, ",");
    var2 = atoi(token);

    token = strtok(NULL, ",");
    var3 = atoi(token);

    // Print the parsed variables to the Serial Monitor
    Serial.print("var1: ");
    Serial.println(var1);
    Serial.print("var2: ");
    Serial.println(var2);
    Serial.print("var3: ");
    Serial.println(var3);

    //Serial.println("Angle1:" + var1+"Angle2:" + var2 + "Angle3:" + var3);
    servo1.write(var1);
    servo2.write(var2);
    servo3.write(var3);

  }
}