工创赛垃圾分类赛道Arduino板 控制两舵机实现上下左右转动的代码

在工创赛垃圾分类项目中，使用Arduino板控制两舵机实现垃圾箱的开合或者垃圾分类机械臂的移动通常涉及电机控制的基础。以下是一个简单的示例代码，展示了如何使用Arduino Uno或类似板子操控两个舵机：

#include <Servo.h> // 引入Arduino的Servo库

// 定义舵机对象，假设舵机A连接数字9，B连接数字10
Servo servoA = Servo(9);
Servo servoB = Servo(10);

void setup() {
  // 初始化舵机
  servoA.attach(9); // 连接9号引脚
  servoB.attach(10); // 连接10号引脚

  // 设置舵机的最大角度范围，一般为180度
  servoA.write(0);
  servoB.write(0); // 都处于中间位置
}

void loop() {
  // 上下转动舵机A（比如代表垃圾桶打开）
  for (int angle = 0; angle <= 180; angle += 5) {
    servoA.write(angle);
    delay(50); // 暂停一段时间让动作平滑
  }
  
  // 稍微等待一会儿
  delay(500);
  
  // 下转到初始位置
  for (angle = 180; angle >= 0; angle -= 5) {
    servoA.write(angle);
    delay(50);
  }

  // 同理，控制舵机B实现左右转动（假设左舵机代表往左移动，右舵机代表往右移动）
  // ...重复上述过程，只是将servoA替换成servoB，并调整旋转方向
}