#定義 TRIGPIN 10
#定義 ECHOPIN 13
#定義 LED1 8
#定義 LED2 9
長 平(){
digitalWrite(TRIGPIN,LOW);
delayMicroseconds(2);
digitalWrite(TRIGPIN,HIGH);
delayMicroseconds(10);
digitalWrite(TRIGPIN,LOW);
返回 pulseIn(ECHOPIN,高)/ 58 ;
}
無效 設置(){
pinMode(TRIGPIN,OUTPUT);
pinMode(ECHOPIN,輸入);
pinMode(LED1,OUTPUT);
pinMode(LED2,OUTPUT);
}
空隙 環(){
長厘米= 平();
如果(厘米<= 5 ){
digitalWrite(LED1,HIGH);
延遲(厘米* 1.5 + 10);
digitalWrite(LED1,LOW);
digitalWrite(LED2,HIGH);
延遲(厘米* 1.5 + 10);
digitalWrite(LED2,LOW);
}
延遲(100);
}