arduino写一个控制5轴机械臂到指定角度运动的代码

下面是一个简单的Arduino代码，用于控制5轴机械臂到指定角度运动：

#include <Servo.h>

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

// 定义5个舵机对应的引脚
int servo1_pin = 2;
int servo2_pin = 3;
int servo3_pin = 4;
int servo4_pin = 5;
int servo5_pin = 6;

void setup() {
  // 将每个舵机对象绑定到对应的引脚
  servo1.attach(servo1_pin);
  servo2.attach(servo2_pin);
  servo3.attach(servo3_pin);
  servo4.attach(servo4_pin);
  servo5.attach(servo5_pin);
}

void loop() {
  // 控制5个舵机到指定角度
  servo1.write(90);
  servo2.write(45);
  servo3.write(120);
  servo4.write(60);
  servo5.write(180);

  // 延时一段时间
  delay(1000);
}

在这个代码中，我们使用了Arduino自带的Servo库来控制5个舵机。首先，我们需要定义5个舵机对象，并将每个舵机对象绑定到对应的引脚。然后，在loop()函数中，我们可以使用servo.write(angle)函数来控制每个舵机到指定的角度。在这个例子中，我们让第一个舵机转到90度，第二个舵机转到45度，第三个舵机转到120度，第四个舵机转到60度，第五个舵机转到180度。最后，我们延时1秒钟，让机械臂停留在这个位置。