#include <Servo.h>

// it same as #define
// #define led_in 5
const int led_in = 5;
const int trigPin = 7;
const int echoPin = 8;
const int motionPin = 4;

Servo myServo;
Servo myServo2;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  // Serial.begin(115200);
  pinMode(A0, INPUT);
  pinMode(motionPin, INPUT);
  myServo.attach(6);
  myServo2.attach(9);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);

  pinMode(led_in, OUTPUT);
}

void loop() {
  // put your main code here, to run repeatedly:
  long distance, duration, analogVal;

  digitalWrite(trigPin, LOW);
  // delay(10);
  digitalWrite(trigPin, HIGH);
  // delay(10);
  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);
  distance = (duration * 0.034) / 2;
  int motion_val = digitalRead(motionPin);

  if (distance > 150 && distance < 200) {
    myServo.write(90);
    digitalWrite(led_in, HIGH);
    // delay(500);
  } else if (distance > 200) {
    myServo.write(200);
    digitalWrite(led_in, HIGH);
    // delay(500);
  } else {
    myServo.write(0);
    digitalWrite(led_in, LOW);
    // delay(500);
  }

  if (motion_val == HIGH) {
    long degress_servo = 180;
    for (int i = 0; i <= degress_servo; i++) {
      myServo2.write(i);
      delay(10);
    }

    for (int i = degress_servo; i > 0; i--) {
      myServo2.write(i);
      delay(10);
    }
  } else {
    myServo2.write(0);
  }
}