关于使用数组控制多个舵机的问题

leiping123

当有多个舵机时（如机械臂有6个舵机），要想使每个舵机都达到设定的角度，在写控制程序时非常麻烦，我想利用数组对多个舵机进行控制。但执行时舵机缺不工作，也不知道问题出在什么地方，请群中的高手指点，谢谢！

代码如下：
#include <Servo.h>

Servo myservo[6];  

int pos = 0;   
void setup()
{
  for (int i=1;i<=6;i++)
  {
  myservo[i].attach(i+3);  
  }
}

void run(int x,int d)
{
  if (myservo[x].read()<d)
  {
for(pos = myservo[x].read(); pos < d; pos += 1)  
  {                                
    myservo[x].write(pos);         
    delay(15);                       
  }
  }
  else
  {
  for(pos = myservo[x].read(); pos>=d; pos-=1)     
  {                                
   myservo[x].write(pos);        
    delay(15);                        
  }
  }
}
void loop()
{
run(3,90);    //3号舵机转90度；
run(5,30);   //5号舵机转30度；

}