用arduino 写一个控制5个舵机到指定角度和速度的代码

以下是一个简单的示例代码，用于控制5个舵机同时旋转到指定角度和速度。在此示例中，我们假定您使用的是Arduino Uno板和SG90舵机。请注意，您需要将每个舵机的信号线连接到Arduino的数字引脚上，并且您需要使用外部电源来为舵机供电。

#include <Servo.h>

Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;

int angle1 = 90; //初始角度
int angle2 = 90;
int angle3 = 90;
int angle4 = 90;
int angle5 = 90;

int speed1 = 10; //旋转速度
int speed2 = 10;
int speed3 = 10;
int speed4 = 10;
int speed5 = 10;

void setup() {
  servo1.attach(2); //将舵机信号线连接到数字引脚2
  servo2.attach(3);
  servo3.attach(4);
  servo4.attach(5);
  servo5.attach(6);
}

void loop() {
  servo1.write(angle1); //将舵机旋转到指定角度
  servo2.write(angle2);
  servo3.write(angle3);
  servo4.write(angle4);
  servo5.write(angle5);

  angle1 += speed1; //增加舵机的角度
  angle2 += speed2;
  angle3 += speed3;
  angle4 += speed4;
  angle5 += speed5;

  if (angle1 > 180 || angle1 < 0) { //如果舵机角度超出范围，则反转舵机速度
    speed1 = -speed1;
  }
  if (angle2 > 180 || angle2 < 0) {
    speed2 = -speed2;
  }
  if (angle3 > 180 || angle3 < 0) {
    speed3 = -speed3;
  }
  if (angle4 > 180 || angle4 < 0) {
    speed4 = -speed4;
  }
  if (angle5 > 180 || angle5 < 0) {
    speed5 = -speed5;
  }

  delay(50); //延迟一点时间，让舵机有足够的时间旋转到目标角度
}

请注意，此示例仅控制每个舵机的速度和角度，而不考虑它们之间的同步。如果您需要更精确的控制，您可能需要使用更高级的算法来计算每个舵机的速度和角度。