Arduino机械臂操作（1）--三轴

参考链接：https://blog.csdn.net/u010944680/article/details/42319775

利用arduino设置机械臂角度

代码如下：

#include <Servo.h> 

Servo myservo0;
Servo myservo1;
Servo myservo2;
Servo myservo3;
Servo myservo4;

 //创建一个舵机控制对象  
 
// 该变量用与存储舵机角度位置  

void setup() 
{ 
  Serial.begin(9600);
  //用的引脚为2、3、4、5、6、
  myservo0.attach(2);
  myservo1.attach(3);
  myservo2.attach(4);
  myservo3.attach(5);
  myservo4.attach(6);
    
  myservo3.write(0);  
  myservo4.write(0);    

// 该舵机由arduino第2，3，4，5，6脚控制  
} 

void loop() 
{  
  if (Serial.available()) {  // 检查串口缓存是否有数据等待传输 
    char servoName = Serial.read();   //获取整数,电机指令中电机编号信息
 
    Serial.print("servoName = ");
    Serial.print(servoName);    
    Serial.print(" , ");      
    
    int data = Serial.parseInt();   //获取电机指令中电机角度信息
 
    switch(servoName){ //根据电机指令中电机信息决定对哪一个电机进行角度设置
      case 'a':   // 电机指令a
        myservo0.write(data);
        Serial.print("Set base servo value: ");
        Serial.println(data);
        break;
      case 'b':  // 电机指令b
        myservo1.write(data);
        Serial.print("Set rArm servo value: ");
        Serial.println(data);
        break;
      case 'c':   // 电机指令c  
        myservo2.write(data);
        Serial.print("Set fArm servo value: ");
        Serial.println(data);
        break;
      case 'd':   // 电机指令d 
        myservo3.write(data);  
        Serial.print("Set claw servo value: ");
        Serial.println(data);
        break;
    }
  }
}