DF-2WD + DFRobot Romeo+DFRobot Bluetooth V3 + Amarino

[draconid]

Witam!

Od jakiegoś czasu interesuje się Arduino i zainteresował mnie klon/płytka DFRobot Romeo. Chcę zbudować za jej pomocą robota/platformę mobilną sterowaną za pomocą telefonu z androidem. Posiadam DF-2WD bo takie oznaczenia ma korpus, DFRobot Romeo sterownik, DFRobot Bluetooth V3 moduł bluetooth oraz zainstalowałem na moim telefonie samsung galaxy mini 2 program Amarino

http://www.amarino-toolkit.net/

Dzięki niemu mogę łatwo sparować telefon z modułem V3.

Problem jest taki, że program który wgrałem już do Romeo działa jako sterowanie z klawiatury a chciałbym, żeby współpracowało z modułem V3

//Standard PWM DC control
int E1 = 5;     //M1 Speed Control
int E2 = 6;     //M2 Speed Control
int M1 = 4;    //M1 Direction Control
int M2 = 7;    //M1 Direction Control


void stop(void)                    //Stop
{
 digitalWrite(E1,LOW);   
 digitalWrite(E2,LOW);      
}   
void advance(char a,char b)          //Move forward
{
 analogWrite (E1,a);      //PWM Speed Control
 digitalWrite(M1,HIGH);    
 analogWrite (E2,b);    
 digitalWrite(M2,HIGH);
}  
void back_off (char a,char b)          //Move backward
{
 analogWrite (E1,a);
 digitalWrite(M1,LOW);   
 analogWrite (E2,b);    
 digitalWrite(M2,LOW);
}
void turn_L (char a,char b)             //Turn Left
{
 analogWrite (E1,a);
 digitalWrite(M1,LOW);    
 analogWrite (E2,b);    
 digitalWrite(M2,HIGH);
}
void turn_R (char a,char b)             //Turn Right
{
 analogWrite (E1,a);
 digitalWrite(M1,HIGH);    
 analogWrite (E2,b);    
 digitalWrite(M2,LOW);
}
void setup(void) 
{ 
 int i;
 for(i=4;i<=7;i++)
   pinMode(i, OUTPUT);  
 Serial.begin(19200);      //Set Baud Rate
 Serial.println("TEST R2D2 na klawiaturze");
} 
void loop(void) 
{
 if(Serial.available()){
   char val = Serial.read();
   if(val != -1)
   {
     switch(val)
     {
     case 'U'://Move Forward
       advance (255,255);   //move forward in max speed
       break;
     case 'D'://Move Backward
       back_off (255,255);   //move back in max speed
       break;
     case 'L'://Turn Left
       turn_L (100,100);
       break;       
     case 'R'://Turn Right
       turn_R (100,100);
       break;
     case 'a':
       Serial.println("Hello");
       break;
     case 'C':
       stop();
       break;
     }
   }
   else stop();  
 }
}

R2D2 to moje oznaczenie i nie wiem w jaki sposób zaprogramować sterownik do współpracy z modułem V3.

http://www.dfrobot.com/wiki/index.php?title=DF-BluetoothV3_Bluetooth_module_(SKU:TEL0026)

na wiki producenta jest kod do arduino jak to zrobić ale nie wiem jak połączyć to co mam do sterowania z klawiatury.

Amarino ma możliwość wysyłania znaków przez bluetooth.

myślałem o czymś takim:

void setup(){ 
 Serial.begin(9600); 
} 

void loop(){ 
 if (Serial.available()){ 
   Serial.print(Serial.read()); 
 } 
}

ale nie wiem jak połączyć programy.

Ma ktoś pomysł?

Za wszelką odpowiedź pięknie dziękuję

[ Dodano: 25-03-2013, 12:17 ]

Już dziękuję znalazłem odpowiedź przesawiłem transmisję z 19200 na 9600 i działa