超声波模块程序详解.doc

《超声波模块程序详解.doc》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、intTrigpin=7;//定义模块触发引脚intEchopin=5;//定义模块接收引脚floatDistance;//定义距离变量voidsetup(){pinMode(Echopin,INPUT);pinMode(Trigpin,OUTPUT);Serial.begin(9600);//启动串口功能}voidloop(){Distance=Measurement();//调用测量函数，将采得的值给变量DistanceSerial.print(Distance);//在端口输出距离Serial.p

2、rintln("cm");//输出单位，并换行delay(2000);}floatMeasurement(){floatdistance;//定义一个局部变量digitalWrite(Trigpin,LOW);//初始化触发引脚delayMicroseconds(2);digitalWrite(Trigpin,HIGH);//给触发引脚一个信号，使模块发出声波delayMicroseconds(10);digitalWrite(Trigpin,LOW);//结束声波信号distance=(pulseIn

3、(Echopin,HIGH)*17)/1000;//计算距离returndistance;//将算得的距离返回给变量distance}伺服舵机+超声波模块#includeintTrigpin=7;//定义模块触发引脚intEchopin=5;//定义模块接收引脚floatDistance;//定义距离变量Servomyservo3;voidsetup(){myservo3.attach(3);pinMode(Echopin,INPUT);pinMode(Trigpin,OUTPUT);

4、Serial.begin(9600);//启动串口功能}voidloop(){myservo3.write(0);delay(2000);Distance=Measurement();//调用测量函数，将采得的值给变量DistanceSerial.print(Distance);//在端口输出距离Serial.println("cm");//输出单位，并换行myservo3.write(90);delay(2000);Distance=Measurement();//调用测量函数，将采得的值给变量Dis

5、tanceSerial.print(Distance);//在端口输出距离Serial.println("cm");//输出单位，并换行myservo3.write(178);delay(2000);Distance=Measurement();//调用测量函数，将采得的值给变量DistanceSerial.print(Distance);//在端口输出距离Serial.println("cm");//输出单位，并换行}floatMeasurement(){floatdistance;//定义一个局部变

6、量digitalWrite(Trigpin,LOW);//初始化触发引脚delayMicroseconds(2);digitalWrite(Trigpin,HIGH);//给触发引脚一个信号，使模块发出声波delayMicroseconds(10);digitalWrite(Trigpin,LOW);//结束声波信号distance=(pulseIn(Echopin,HIGH)*17)/1000;//计算距离returndistance;//将算得的距离返回给变量distance}