Part2.3 Servo控制

#include <SoftwareSerial.h>

#include <Servo.h>

Servo servoA0,servoA1,servoA2,servoA3,servoA4,servoA5;

SoftwareSerial BT(3,2); // TX, RX

int y,z ;

int S0,S1,S2,S3,S4,S5;

int num[3];

void setup() {

Serial.begin(9600);

BT.begin(38400);//bluetooth baud rate

BT.setTimeout(10);

servoA0.attach(4);

servoA1.attach(5);

servoA2.attach(6);

servoA3.attach(7);

servoA4.attach(8);

servoA5.attach(9);

}

void loop() {

bt();

servoA0.write(S0);

servoA1.write(S1);

servoA2.write(S2);

servoA3.write(S3);

servoA4.write(S4);

servoA5.write(S5);

}

void bt(){

if(BT.available()>0){

int x = BT.read();

if(y==97){

num[1]=x;

S0=num[1];

Serial.print("A0=");

Serial.println(num[1]);

y=0;

x=0;

}

if(y==98){

num[1]=x;

S1=num[1];

Serial.print("A1=");

Serial.println(num[1]);

y=0;

x=0;

}

if(y==99){

num[1]=x;

S2=num[1];

Serial.print("A2=");

Serial.println(num[1]);

y=0;

x=0;

}

if(y==100){

num[1]=x;

S3=num[1];

Serial.print("A3=");

Serial.println(num[1]);

y=0;

x=0;

}

if(y==101){

num[1]=x;

S4=num[1];

Serial.print("A4=");

Serial.println(num[1]);

y=0;

x=0;

}

if(y==102){

num[1]=x;

S5=num[1];

Serial.print("A5=");

Serial.println(num[1]);

y=0;

x=0;

}

y=x;

}

}