// Arduino firmware for Android Robot Project
// Command: X F B L R FR FL BR BL H
// PORT_map: - 1 2 4 8 9 5 10 6 16 (PORTB HEX)
// Received: 0 1 2 3 4 5 6 7 8 9 (from router)
// Pin - 8 9 10 11 811 810 911 910 12
unsigned char port_map[10]={0,1,2,4,8,9,5,10,6,16};
unsigned int in_char;
unsigned long counter=0;
unsigned char in_byte=0;
unsigned int test=0;
void setup()
{
DDRB=B11111111; //PORTB as OUTPUT
Serial.begin(9600); //Start Serial
}
char recv_char()
{
while (counter < 15000) //Pulse of command
{
counter++;
if (Serial.available() > 0)
{
in_byte = Serial.read();
test=(int)in_byte-48;
Serial.print(test);
counter = 0;
return test;
}
}
counter=0;
return 0;
}
void loop()
{
in_char=recv_char();
PORTB=port_map[in_char]; //Port map
}
just read the algoritme brother
i think it was clearly