arduino, eletrônica, robotica...

Adicionar um comando no arduino para executar uma linha de comando no servo motor.

Olá, eu tenho um braço robótico controlado por bluetooth (HC 06), Eu queria colocar uma linha de comando onde se eu apressinar um botão como "D" no APP ele executase um ciculo como por exemplo esse:

{

for(pos = 0; pos /span> 90; pos++)

{

s.write(pos);

delay(15);

}

delay(1000);

for(pos = 90; pos >= 0; pos--)

{

s.write(pos);

delay(15);

}

O código atualmente que eu utilizo é esse:

#include <SoftwareSerial.h>

#include <Servo.h>
Servo myservo1, myservo2, myservo3, myservo4;

int bluetoothTx = 7;
int bluetoothRx = 8;

SoftwareSerial bluetooth(bluetoothTx, bluetoothRx);

void setup()
{
myservo1.attach(3);
myservo2.attach(5);
myservo3.attach(6);
myservo4.attach(9);
//Setup usb serial connection to computer
Serial.begin(9600);

//Setup Bluetooth serial connection to android
bluetooth.begin(9600);
}

void loop()
{
//Read from bluetooth and write to usb serial
if(bluetooth.available()>= 2 )
{
unsigned int servopos = bluetooth.read();
unsigned int servopos1 = bluetooth.read();
unsigned int realservo = (servopos1 *256) + servopos;
Serial.println(realservo);

if (realservo >= 0 && realservo <180){
int servo1 = realservo;
servo1 = map(servo1, 0,180,0,180);
myservo1.write(servo1);
Serial.println("servo 1 ON");
delay(10);

}

if (realservo >=180 && realservo <360){
int servo2 = realservo;
servo2 = map(servo2,180,360,0,180);
myservo2.write(servo2);
Serial.println("servo 2 On");
delay(10);

}

if (realservo >=360 && realservo < 540){
int servo3 = realservo;
servo3 = map(servo3, 360, 540,0,180);
myservo3.write(servo3);
Serial.println("servo 3 On");
delay(10);
}
if (realservo >=540 && realservo < 720){
int servo4 = realservo;
servo4 = map(servo4, 540, 720,0,180);
myservo4.write(servo4);
Serial.println("servo 4 On");
delay(10);
}
}
}