＃定義 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）;
}
