怎么写arduino和舵机驱动板控制四个180度舵机依次转动的程序，用servoCmd函数

您好，以下是如何使用 Arduino 和舵机驱动板控制四个 180 度舵机依次转动的程序，使用 servoCmd 函数实现：

#include <Servo.h>

// 定义舵机连接引脚和最小/最大角度
#define SERVO_1_PIN 2
#define SERVO_2_PIN 3
#define SERVO_3_PIN 4
#define SERVO_4_PIN 5
#define SERVO_MIN_ANGLE 0
#define SERVO_MAX_ANGLE 180

// 定义舵机对象
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;

void setup() {
  // 以舵机连接的引脚初始化
  servo1.attach(SERVO_1_PIN);
  servo2.attach(SERVO_2_PIN);
  servo3.attach(SERVO_3_PIN);
  servo4.attach(SERVO_4_PIN);
}

void loop() {
  // 依次循环控制四个舵机转动
  for (int i = 0; i < 4; i++) {
    // 控制第 i 个舵机转动到指定角度
    servoCmd(i, SERVO_MAX_ANGLE);
    delay(1000); // 等待 1 秒钟
    servoCmd(i, SERVO_MIN_ANGLE);
    delay(1000); // 等待 1 秒钟
  }
}

// 控制指定编号的舵机转动到指定角度
void servoCmd(uint8_t num, uint8_t angle) {
  switch (num) {
    case 0:
      servo1.write(angle);
      break;
    case 1:
      servo2.write(angle);
      break;
    case 2:
      servo3.write(angle);
      break;
    case 3:
      servo4.write(angle);
      break;
    default:
      break;
  }
}

以上代码假设舵机已经连接到 Arduino 的引脚 2、3、4 和 5 上，您可以根据实际连接情况进行修改。

顺序控制四个舵机转动的方式如下：
- 控制第 1 个舵机转动到最大角度，等待一秒钟，然后控制它转动回最小角度。
- 控制第 2 个舵机转动到最大角度，等待一秒钟，然后控制它转动回最小角度。
- 控制第 3 个舵机转动到最大角度，等待一秒钟，然后控制它转动回最小角度。
- 控制第 4 个舵机转动到最大角度，等待一秒钟，然后控制它转动回最小角度。
- 从头再来，不断循环。

希望这可以帮助您解决问题，如有不明白的地方可以继续向我提问哦。