超声传感器测距程序(典型):
const int TrigPin = 2; const int EchoPin = 3; float cm;
void setup(){ Serial.begin(9600); pinMode(TrigPin,OUTPUT); pinMode(EchoPin,INPUT); }
void loop(){ digitalWrite(TrigPin,LOW); //低高低电平发送短时间脉冲TrigPin delayMicroseconds(2); digitalWrite(TrigPin,HIGH); delayMicroseconds(10); digitalWrite(TrigPin,LOW);
cm = pulseIn(EchoPin,HIGH) / 58cm
cm = (int(cm * 100) / 100Serial.print(cm); Serial.print("cm");//串口输出 Serial.println(); delay(1000); }