아두이노 초음파거리센서 코드( 연동 )

#define TRIG_PIN 6
#define ECHO_PIN 7

unsigned long duration, distance;
int send_time = 500;
unsigned long befor_time = 0;
String last_data = "S";
void setup() {
  pinMode(ECHO_PIN, INPUT);
  pinMode(TRIG_PIN, OUTPUT);
  Serial.begin(115200);
  befor_time = millis();  
}

void loop() {
  unsigned long now = millis();
  if( now - befor_time >= send_time ){
    befor_time = now;
    digitalWrite(TRIG_PIN, HIGH);
    delayMicroseconds(10);
    digitalWrite(TRIG_PIN, LOW);  
    duration = pulseIn(ECHO_PIN, HIGH);
    distance = ((float)(340 * duration)/1000)/2;
    String state;
    if( distance >= 2000 ){ // Safety
      state = 'S';
    }else if(distance < 2000 && distance > 1000 ){ // Warning 
      state = 'W';
    }else{  // Dangerous
      state = 'D';
    }    
    if( state != last_data ){
      last_data = state;
      Serial.print( state + "\n");
    }else{
      Serial.print("DISTANCE\r" + String(distance) + "\n"); 
    }
  }
}

★ [ IOT코아 ]에서 실행방법은 아래 링크를 참고하세요

 

https://koa-rea.tistory.com/52

두개의 아두이노 보드 연동하기