首页 › Arduino › 两个超声波的测试

tgyfish 发表于 2013-1-23 00:53:39

两个超声波的测试

哎呀难受啊要去优酷上传视频可累了这网速害我现在才好！给小白的一个学习吧，参考Ansifa的单个超声波的教程我就弄个2个的，供小白研究，先上程序~~~
const int TrigPin = 2;
const int EchoPin = 3;
const int Tri = 4;
const int Ech = 5;
float cm1;
float cm2;
void setup()
{
Serial.begin(9600);
pinMode(TrigPin, OUTPUT);
pinMode(EchoPin, INPUT);
pinMode(Tri, OUTPUT);
pinMode(Ech, INPUT);
pinMode(7, OUTPUT);
pinMode(8, OUTPUT);
}

void loop()
{
int i;
for(i=1;i<=2;i++)
{
if(i==1)
{
    digitalWrite(TrigPin, LOW); //低高低电平发一个短时间脉冲去TrigPin
    delayMicroseconds(2);
    digitalWrite(TrigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(TrigPin, LOW);

    cm1 = pulseIn(EchoPin, HIGH) / 58.0; //将回波时间换算成cm
    cm1 = (int(cm1 * 100.0)) / 100.0; //保留两位小数
    Serial.print(cm1);
    Serial.print("cm1");
    Serial.println();
    delay(10);

    if(cm1<5)
    {
      digitalWrite(7, HIGH);
    }
      else
      {
      digitalWrite(7, LOW);
      }
   
}
delay(50);
if(i==2)
{
    digitalWrite(Tri, LOW); //低高低电平发一个短时间脉冲去Tri
    delayMicroseconds(2);
    digitalWrite(Tri, HIGH);
    delayMicroseconds(10);
    digitalWrite(Tri, LOW);

    cm2 = pulseIn(Ech, HIGH) / 58.0; //将回波时间换算成cm
    cm2 = (int(cm2* 100.0)) / 100.0; //保留两位小数
    Serial.print(cm2);
    Serial.print("cm2");
    Serial.println();
    delay(10);

    if(cm2<5)
    {
      digitalWrite(8, HIGH);
    }
      else
      {
      digitalWrite(8, LOW);
      }
   
}
}
}
好吧程序部分有很多可以改动的地方，好吧视频我也不知道是否ok~传视频咯！http://v.youku.com/v_show/id_XNTA1NTM4OTk2.html线路连接参考Ansifa大神的单个连接，串口查看的图我就不贴了有兴趣的可是自己玩玩，仅供参考！

tgyfish 发表于 2013-1-23 18:55:48

由于超声波的缺陷，补充一下~超过量程以后超声波显示为负值，这样的话上面程序有个错误的地方，加一句&&cm1>0就ok了，cm2也一样，占自己的沙发发发~

jifukui 发表于 2014-4-1 15:06:15

我想知道为什么得出距离要除以58.0？？？

tgyfish 发表于 2014-4-1 20:08:26

jifukui 发表于 2014-4-1 15:06 static/image/common/back.gif
我想知道为什么得出距离要除以58.0？？？

The speed of sound is 340 m/s or 29 microseconds per centimeter.

查看完整版本: 两个超声波的测试