Arduino驱动四个电机

一、Arduino驱动四个电机

二、代码分析

#include <Servo.h>

Servo base,fArm,rArm,claw;  // 创建4个电机

int dataIndex = 0;    // 定义一个整型变量显示电机编号

void setup() {
  base.attach(11);    // base电机连接到11脚，代号b
  base.attach(10);    // fArm电机连接到10脚，代号r
  base.attach(9);     // rArm电机连接到9脚，代号f
  base.attach(6);     // claw电机连接到6脚，代号c
  Serial.begin(9600);
  Serial.println("Please input serial data");
}

void loop() {
  if(Serial.available())
  {
    char servoName=Serial.read();//获取电机指令中电机编号信息

    Serial.print("servoName=");
    Serial.print(servoName);
    Serial.print(",");

    int data=Serial.parseInt();//获取电机指令中电机角度信息

    switch(servoName)//根据电机指令中电机信息觉得设置哪个电机
     {
        case'b':
          base.write(data);
          Serial.print("Set base servo value:");
          Serial.println(data);
          break;

        case'r':
          base.write(data);
          Serial.print("Set fArm servo value:");
          Serial.println(data);
          break;

         case'f':
          base.write(data);
          Serial.print("Set rArm servo value:");
          Serial.println(data);
          break;

        case'c':
          base.write(data);
          Serial.print("Set claw servo value:");
          Serial.println(data);
          break;       
     }    
   }
}