엘레베이터 문 손끼임 방지를 만들고 싶은데요 빛을 조도센서에 쏘고 조도센서로 빛이 많이 들어오면 서보모터가 정상작동을하고 서보모터 작동중에 빛이 들어오지않으면 그 즉시 역 회전하는 코딩을 하고 싶은데 안되네요 혹시 도와주실수 있나요? ㅠㅠㅠ 

  #include <Servo.h> //서보 모터 헤더 파일 추가

Servo myServo;



int SERVO_pin = 3; //서보 모터 핀 번호 지정

int COS_pin = A0; //조도 센서 핀 번호 지정





void setup() {

 myServo.attach(SERVO_pin); //서보 모터 2번 핀으로 초기화

 pinMode(COS_pin, INPUT); //조도 센서 핀 모드 설정

 Serial.begin(9600);

}

void loop() {

 int cds_value = analogRead(COS_pin); //조도 센서 값 읽어오기

 Serial.println(String("cds:")+cds_value);



 if(cds_value < 400) { 

 

    myServo.write(100); // 역방향으로 최고속도 회전

    delay(5000); // 5초 동작

    myServo.write(91); // 정지

    delay(5000);  // 5초 동작

    myServo.write(80);  // 정방향으로 최고속도 회전

    delay(5000); // 5초동작

    myServo.write(92); // 정지

     exit(0);

 

 } 

 else{

  

   myServo.write(80);  // 정방향으로 최고속도 회전

    delay(5000); // 5초동작

    myServo.write(92); // 정지

     exit(0);

 

  }

 }