網頁文章 網頁文章

 

 

 

 

const int trig = 5;

 

const int echo = 6;

 

const int inter_time = 1000;

 

int time = 0;

 

 

 

 

void setup() {

 

  Serial.begin(9600);

 

  pinMode (trig, OUTPUT);

 

  pinMode (echo, INPUT);

  

  pinMode (13,OUTPUT);

 

}

 

 

 

 

void loop() {

 

  float duration, distance;

 

  digitalWrite(trig, HIGH);

 

  delayMicroseconds(1000);

 

  digitalWrite(trig, LOW);

 

  duration = pulseIn (echo, HIGH);

 

  distance = (duration/2)/29;

 

  Serial.print("Data:");

 

  Serial.print (time/1000);

 

  Serial.print(", d = ");

 

  Serial.print(distance);

 

  Serial.println(" cm");

  

  if (distance > 30)

  {

  digitalWrite(13, HIGH);

  }

  else

  {

      digitalWrite(13, LOW);

 

  }

  time = time + inter_time;

 

  delay(inter_time);

 

}