一、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;
}
}
}