代码如下:
int ledS = 3;
int ledR = 7;
int ledY = 6;
int ledG = 5;
const int Trigp = 8;
const int Echop = 9;
float cm;
void setup() {
pinMode(ledR,OUTPUT);
pinMode(ledY,OUTPUT);
pinMode(ledG,OUTPUT);
Serial.begin(9600);
pinMode(Trigp,OUTPUT);
pinMode(Echop,INPUT);
}
void loop() {
digitalWrite(Trigp,LOW);
delayMicroseconds (2);
digitalWrite(Trigp,HIGH);
delayMicroseconds(10);
digitalWrite(Trigp,LOW);
cm = pulseIn(Echop,HIGH) / 58.0;
cm = (int(cm * 100.0)) / 100.0;
Serial.print("back:");
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(1000);
if (cm
digitalWrite(ledR,HIGH);
digitalWrite(ledY,LOW);
digitalWrite(ledG,LOW);
digitalWrite(ledS,LOW);
}
else if( cm>6
digitalWrite(ledY,HIGH);
digitalWrite(ledR,LOW);
digitalWrite(ledG,LOW);
digitalWrite(ledS,LOW);
}
else if(cm>11
digitalWrite(ledG,HIGH);
digitalWrite(ledY,LOW);
digitalWrite(ledR,LOW);
digitalWrite(ledS,LOW);
}
else if (cm>30){
digitalWrite(ledS,HIGH);
digitalWrite(ledY,LOW);
digitalWrite(ledG,LOW);
digitalWrite(ledR,LOW);
}
}
本人新手望各位大神解决