아두이노 코드

#include <Servo.h>

Servo servo_1;

Servo servo_2;

void setup() {

  servo_1.attach(3);

  servo_2.attach(4);

}

void go(){

  for(int angle = 130; angle >= 50; angle--) {

    servo_2.write(angle);

    delay(5);

  }

  for(int angle = 110; angle >= 70; angle--) {

    servo_1.write(angle);

    delay(5);

  }

    for(int angle = 50; angle <= 130; angle++) {

    servo_2.write(angle);

    delay(5);

  }

  for(int angle = 70; angle <= 110; angle++) {

    servo_1.write(angle);

    delay(5);

  }

}

void back(){

    for(int angle = 110; angle >= 70; angle--) {

    servo_1.write(angle);

    delay(5);

  }

  for(int angle = 110; angle >= 70; angle--) {

    servo_2.write(angle);

    delay(5);

  }

    for(int angle = 70; angle <= 110; angle++) {

    servo_1.write(angle);

    delay(5);

  }

  for(int angle = 70; angle <= 110; angle++) {

    servo_2.write(angle);

    delay(5);

  }

}

void loop() {

  go();

  go();

  go();

  delay(500);

  back();

  back();

  back();

  delay(500);

 

}