Stensat StenBOT Rover Kit, Руководство пользователя

Страница: 117 / 180

117 117
Using the Function
●
The program to the right
shows how the function
is included in the
program and where it is
located relative to the
setup() and loop
functions.
●
The function has to be
located before the code
that calls the function.
long ultrasonic()
{
digitalWrite(5,LOW);
delayMicroseconds(2);
digitalWrite(5,HIGH);
delayMicroseconds(10);
digitalWrite(5,LOW);
long distance = pulseIn(3,HIGH);
if(distance == 0) return(1000);
distance = distance/58;
return(distance);
}
void set()
{
Serial.begin(9600);
pinMode(3,INPUT);
pinMode(5,OUTPUT);
}
void loop()
{
long a = ultrasonic();
Serial.println(a);
}