求大神支招

a463637283

我用舵机控制超声波
超声波读取都有没有问题  
肯定我的程序有问题
我是10cm转90度，可是为啥 读到一个10cm就会执行三个if，肯定if那里错了，就是不知道咋改。谢谢了

#include <Servo.h>

Servo myservo;

int pos = 0;
const int TrigPin = 2;
const int EchoPin = 3;
float cm;
void setup()
{
Serial.begin(9600);
pinMode(TrigPin, OUTPUT);
pinMode(EchoPin, INPUT);
myservo.attach(9);  
}
void loop()
{
digitalWrite(TrigPin, LOW); //低高低电平发一个短时间脉冲去TrigPin
delayMicroseconds(2);
digitalWrite(TrigPin, HIGH);
delayMicroseconds(10);
digitalWrite(TrigPin, LOW);

cm = pulseIn(EchoPin, HIGH) / 58.0;
cm = (int(cm * 100.0)) / 100.0;
if(cm<10)
{
  myservo.write(90);
  delay(1000);
if(cm<10)
{
  myservo.write(0);                  
delay(1000);
if(cm<10)
{ myservo.write(180);
delay(1000);
}
}
}
delay(1000);
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(1000);
}

Super169

"读到一个10cm就会执行三个if，" 是什麼意思?  是指 cm  = 10 時也會執行 if (cm < 10) 的設定嗎?
如果是這樣的話, 有可能因為 float 的數值, 10 非 10 而做成.  嘗試改成整數作比較試試看看.

eddiewwm

要先要弄清楚以下這段的思路，或許先用文字表達一下。
//
if(cm<10)
{
  myservo.write(90);
  delay(1000);
if(cm<10)
{
  myservo.write(0);                  
delay(1000);
if(cm<10)
{ myservo.write(180);
delay(1000);
}
}
}
//

a463637283

eddiewwm 发表于 2014-4-20 18:44
要先要弄清楚以下這段的思路，或許先用文字表達一下。
//
if(cm

就是距离小于10  第一次转到0度，第二次，180，第三次90度

eddiewwm

a463637283 发表于 2014-4-20 19:43
就是距离小于10  第一次转到0度，第二次，180，第三次90度

按所述思路和原代碼結構方式的參考：
//
  if(cm<10 and TrigCount == 0) //距離小於10cm 並是第一次情況
  {
    myservo.write(0);
    delay(1000);
    TrigCount = 1; // 第一次完成，設為第二次
  }
  else if(cm<10 and TrigCount == 1 )  //距離小於10cm 並是第二次情況
  {
    myservo.write(180);                  
    delay(1000);
    TrigCount = 2; // 第二次完成，設為第三次
  }
  else if(cm<10 and TrigCount == 2)  //距離小於10cm 並是第三次情況
  {
    myservo.write(90);
    delay(1000);
//   TrigCount = 2; // 第三次完成，設為第一次  ** 這個錯了 **
     TrigCount = 0; // 第三次完成，設為第一次  ** 更正 **
}
//

a463637283

eddiewwm 发表于 2014-4-20 21:09
按所述思路和原代碼結構方式的參考：
//
  if(cm

谢了 我试试