模块介绍:
超声波模块介绍
程序源码:
int trig=2;
int echo=3;
int echo_us=0;
int temp=0;
int distanceInteger=0;
int distanceFraction=0;
void setup() {
// put your setup code here, to run once:
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
Serial.begin(9600);
}
void function(void)
{
digitalWrite(trig, HIGH);
delayMicroseconds(20);
digitalWrite(trig, LOW);
echo_us = pulseIn(echo, HIGH);
if((echo_us < 60000) && (echo_us > 1))
{
temp = (echo_us*1.7)/10;
distanceInteger = temp/10;
distanceFraction = temp%10;
Serial.print("Present distance is: ");
Serial.print(distanceInteger, DEC);
Serial.print('.');
Serial.print(distanceFraction, DEC);
Serial.println("cm");
}
}
void loop() {
// put your main code here, to run repeatedly:
function();
delay(1000);
}
实物图: