Code: task main(){
ubyte DataRec[255]; int msgSize = 0; string Msg = ""; //setBluetoothVisibility(true); //setBluetoothOn();
//setBluetoothRawDataMode();
wait10Msec(200); //while(bBTRawMode == 0){PlayTone(1,300); wait10Msec(1);} writeDebugStreamLine("Conectado...%i",bBTRawMode);
while(1){
writeDebugStreamLine("---------- Messages\n"); for(int i=0; i<=11; i++){ msgSize = cCmdMessageGetSize(i); writeDebugStreamLine("(%i) Mailbox %i", msgSize, i+1); if(msgSize > 0){ cCmdMessageRead(DataRec, msgSize, i);
for(int k=0;k<msgSize; k++){ Msg = Msg + DataRec[k]; DataRec[k]=0; }
writeDebugStream("%s", Msg); } }
writeDebugStreamLine("---------------------\n"); cCmdBTPurgeRcvBuffer(); //nxtReadRawBluetooth(DataRec, 5); //cCmdMessageRead(DataRec,5,4); wait10Msec(100); //writeDebugStreamLine("%i-%i-%i-%i-%i", DataRec[0],DataRec[1],DataRec[2],DataRec[3],DataRec[4]);
} }
|