[아두이노] 초음파 센서 / 거리 측정

초음파 센서

 

더 강한 5V 단자 연결 -> VCC

int trig = 12;
int echo = 11;


void setup()
{
	Serial.begin(9600);
  	pinMode(trig, OUTPUT);
  	pinMode(echo, INPUT);
}

void loop()
{
	long duration;
  
	digitalWrite(trig,HIGH);
  	delayMicroseconds(10);
	digitalWrite(trig,LOW);
  
    duration = pulseIn(echo, HIGH);
    Serial.println(duration);
  
}

마이크로세컨드 출력

 

 

int trig = 12;
int echo = 11;


void setup()
{
	Serial.begin(9600);
  	pinMode(trig, OUTPUT);
  	pinMode(echo, INPUT);
}

void loop()
{
	long duration, distance;
  
	digitalWrite(trig,HIGH);
  	delayMicroseconds(10);
	digitalWrite(trig,LOW);
  
    duration = pulseIn(echo, HIGH);
    
  
 // 거리 = 시간 * 속도(음파속도 340m/s)
  	distance = (duration/2 * 34000)/1000000;
  	Serial.print(distance);
  	Serial.println(" cm");
}

---

거리에 따라 LED 켜지도록

int trig = 12;
int echo = 11;
int led = 5;

void setup()
{
	Serial.begin(9600);
  	pinMode(trig, OUTPUT);
  	pinMode(echo, INPUT);
    pinMode(led, INPUT);
}

void loop()
{
	long duration, distance;
  
	digitalWrite(trig,HIGH);
  	delayMicroseconds(10);
	digitalWrite(trig,LOW);
  
    duration = pulseIn(echo, HIGH);
    
  
 // 거리 = 시간 * 속도(음파속도)
  	distance = (duration/2 * 34000)/1000000;
  	Serial.print(distance);
  	Serial.println(" cm");
  if(distance < 150){
  	digitalWrite(led,HIGH);
  }else{
    digitalWrite(led,LOW);
  }
}

---

int trig = 11;
int echo = 12;
int led = 5;

void setup()
{
  Serial.begin(9600);
    pinMode(trig, OUTPUT);
    pinMode(echo, INPUT);
    pinMode(led, INPUT);
}

void loop()
{
  long duration, distance;
  
  digitalWrite(trig,HIGH);
    delayMicroseconds(10);
  digitalWrite(trig,LOW);
  
    duration = pulseIn(echo, HIGH);
    
  
 // 거리 = 시간 * 속도(음파속도)
    distance = (duration/2 * 34000)/1000000;
    Serial.print(distance);
    Serial.println(" cm");
  if(distance < 30){
    digitalWrite(led,HIGH);
  }else{
    digitalWrite(led,LOW);
  }
}