// MCU BASIC: https://www.basic4mcu.com
// DateTime : 2019-05-30 오후 4:08:27
// by Ok-Hyun Park
//
#include <Servo.h>
Servo servo1;
//
int ledPin=5;
int trigPin=3,echoPin=2;
//
long distance,duration;
//
void setup(){
  servo1.attach(7);
  Serial.begin(9600);
  pinMode(ledPin,OUTPUT);
  pinMode(trigPin,OUTPUT);
  pinMode(echoPin,INPUT);
}
//
void loop(){
  digitalWrite(trigPin,HIGH);     delayMicroseconds(10); digitalWrite(trigPin,LOW);
  duration=pulseIn(echoPin,HIGH); distance=duration*0.034/2;
  Serial.print("distance="); Serial.println(distance);
  if(distance<=15){ digitalWrite(ledPin,HIGH); servo1.write(150); }
  else            { digitalWrite(ledPin,LOW);   servo1.write(0);  }
  delay(100);
}