Question

我试图为我的机器人创造一些眼睛。它将使用伺服旋转超声波仪表HC-SR04 ，但是当我添加代码来驱动这个东西时，伺服停止工作。为什么会这样？我使用的是Arduino 1.5.6和 Arduino Uno R3。

代码：

#include <Servo.h> 

Servo myservo;  // create servo object to control a servo 
                // twelve servo objects can be created on most boards

int pos = 90;    // variable to store the servo position 
int x = 0;
int y = 0;
int hcsr04[4] = {13,12,11,10};
float echoTime = 0;
float distance = 0;
void setup() 
{ 
  myservo.attach(3);  // attaches the servo on pin 9 to the servo object 
  Serial.begin(9600);
  myservo.write(pos);
  for(int i = 0; i < 4; i++)
  {
    pinMode(hcsr04[i], OUTPUT);
  }
  pinMode(hcsr04[1], INPUT);
}

void loop() 
{ 
  x = analogRead(A0);
  y = analogRead(A1);

  if(y < 100)
  {
    pos += 1;
    if(pos >= 175)
    {
      pos -= 10;
    }
    myservo.write(pos);
    delay(10);
  }
  if(y > 900)
  {
    pos -= 1;
    if(pos <= 5)
    {
       pos += 10;
    }
    myservo.write(pos);
  delay(10);
  }
  digitalWrite(hcsr04[0], LOW);
  delayMicroseconds(2);
   digitalWrite(hcsr04[0], HIGH );
  delayMicroseconds(10);
    digitalWrite(hcsr04[0], LOW);
    echoTime = pulseIn(hcsr04[1], HIGH);
   distance = echoTime / 58;
    Serial.println(pos);
}

Answer 1

我认为pulseIn（）函数使用与Servo正在使用的相同的计时器...您可以使用attachInterrupt（）并在回调中减去time（） - oldTime，然后将time（）分配给oldTime

示例：http://arduino.cc/en/Reference/attachInterrupt

当连接传感器时，Arduino驱动的伺服电机停止工作

1 个答案: