一、四组舵机转动效果一样
#include <Servo.h>
Servo base,fArm,rArm,claw;//创建4个电机分别为base,fArm,rArm,claw
int data[5]={0,45,90,135,180};//定义一个包含5个数据的整型数组
void setup()
{
base.attach(11); //base伺服电机连接到引脚11,电机代号b
fArm.attach(10); //fArm伺服电机连接到引脚10,电机代号r
rArm.attach(9); //rArm伺服电机连接到引脚9,电机代号f
claw.attach(6); //claw伺服电机连接到引脚6,电机代号c
}
void loop()
{
for(int i=0;i<=4;i++)
{
base.write(data[i]);//base转动到指定角度
delay(100);
fArm.write(data[i]);//fArm转动到指定角度
delay(100);
rArm.write(data[i]);//rArm转动到指定角度
delay(100);
claw.write(data[i]);//claw转动到指定角度
delay(100);
delay(500);
}
for(int i=4;i>=0;i--)
{
base.write(data[i]);//base转动到指定角度
delay(100);
fArm.write(data[i]);//fArm转动到指定角度
delay(100);
rArm.write(data[i]);//rArm转动到指定角度
delay(100);
claw.write(data[i]);//claw转动到指定角度
delay(100);
delay(500);
}
}
二、四组舵机转动效果不一样
#include <Servo.h>
Servo base,fArm,rArm,claw;//创建4个电机分别为base,fArm,rArm,claw
int data1[5]={0,45,90,135,180};//定义一个包含5个数据的整型数组
int data2[5]={45,90,135,90,45};//定义一个包含5个数据的整型数组
int data3[5]={135,90,45,90,135};//定义一个包含5个数据的整型数组
int data4[5]={180,135,90,45,0};//定义一个包含5个数据的整型数组
void setup()
{
base.attach(11); //base伺服电机连接到引脚11,电机代号b
fArm.attach(10); //fArm伺服电机连接到引脚10,电机代号r
rArm.attach(9); //rArm伺服电机连接到引脚9,电机代号f
claw.attach(6); //claw伺服电机连接到引脚6,电机代号c
}
void loop()
{
for(int i=0;i<=4;i++)
{
base.write(data1[i]);//base转动到指定角度
delay(100);
fArm.write(data2[i]);//fArm转动到指定角度
delay(100);
rArm.write(data3[i]);//rArm转动到指定角度
delay(100);
claw.write(data4[i]);//claw转动到指定角度
delay(100);
delay(500);
}
for(int i=4;i>=0;i--)
{
base.write(data1[i]);//base转动到指定角度
delay(100);
fArm.write(data2[i]);//fArm转动到指定角度
delay(100);
rArm.write(data3[i]);//rArm转动到指定角度
delay(100);
claw.write(data4[i]);//claw转动到指定角度
delay(100);
delay(500);
}
}
#include <Servo.h>
Servo base,fArm,rArm,claw;//创建4个电机分别为base,fArm,rArm,claw
int data2d[4][5]=//定义一个4行5列的二维数组
{
{0,45,90,135,180},
{45,90,135,90,45},
{135,90,45,90,135},
{180,135,90,45,0}
};
void setup()
{
base.attach(11); //base伺服电机连接到引脚11,电机代号b
fArm.attach(10); //fArm伺服电机连接到引脚10,电机代号r
rArm.attach(9); //rArm伺服电机连接到引脚9,电机代号f
claw.attach(6); //claw伺服电机连接到引脚6,电机代号c
}
void loop()
{
for(int i=0;i<=4;i++)
{
base.write(data2d[0][i]);//base转动到指定角度
delay(100);
fArm.write(data2d[1][i]);//fArm转动到指定角度
delay(100);
rArm.write(data2d[2][i]);//rArm转动到指定角度
delay(100);
claw.write(data2d[3][i]);//claw转动到指定角度
delay(100);
delay(500);
}
for(int i=4;i>=0;i--)
{
base.write(data2d[0][i]);//base转动到指定角度
delay(100);
fArm.write(data2d[1][i]);//fArm转动到指定角度
delay(100);
rArm.write(data2d[2][i]);//rArm转动到指定角度
delay(100);
claw.write(data2d[3][i]);//claw转动到指定角度
delay(100);
delay(500);
}
}