Stap 2: programmeren...
int trig = 2;
int echo = 3;
VOID Setup {}
Serial.begin(9600); seriële communicatiepoorten te initialiseren:
pinMode(trig,OUTPUT); declear trig pin uitvoer:
pinMode(echo,INPUT); declear echo pins-ingang:}
void loop {}
stellen variabelen voor de duur van de ping,
en het resultaat van de afstand in centimeters:
lange duur, cm;
digitalWrite (trig, laag);
delayMicroseconds(2);
digitalWrite (trig, hoge);
delayMicroseconds(5);
digitalWrite (trig, laag);
duur = pulseIn (echo, hoge);
de tijd omzetten in een afstand
cm = microsecondsToCentimeters(duration);
Serial.Print(cm);
Serial.Print("cm");
Serial.println();
delay(100); }
lange microsecondsToCentimeters(long microseconds) {}
De snelheid van het geluid is 340 m/s of 29 microseconden per vierkante centimeter.
De ping reist uit en terug, zo vind je de afstand van de
we de helft van de afgelegde afstand nemen-object.
retourneren van microseconden / 29 / 2; }