/* ************************************************************
 * NXT-BT-Request.nxc
 * CH, Chen(Taiwan)
 * 2012.5.29
 * ************************************************************ */

#define BT_CHANNEL    2
#define ARDUINO_SLAVE "Bluetooth_Bee_V"

/* ************************************************************
 * Build_Connection() function
 * 1. Search index of slave device name in bluetooth contact list
 * 2. Call SysCommExecuteFunction(CommExecuteFunctionType cefArgs)
 *    to connect with slave device
 * ************************************************************ */
#define MUST_WAIT_3_SECONDS 3
bool build_Connection(byte BtChannel, const string BtDevname)
{
     string msg;
     bool isOK = FALSE;
     short idx = 0, cmpLen = strlen(BtDevname);

     ClearScreen();
     TextOut(0, LCD_LINE1, "Build Connection");
     TextOut(0, LCD_LINE2, StrCat(" with ", BtDevname));
     
     // Search index of Slave device in BT contact list
     TextOut(0, LCD_LINE4, "Searching Slave ");
     for(short xii=0; xii<BTDeviceCount(); xii++)
     {
        if(strncmp(BTDeviceName(xii), BtDevname, cmpLen)==0)
        {
          idx  = xii;
          isOK = TRUE;
          break;
        }
     }

     if(!isOK)
     {
       TextOut(0, LCD_LINE5, "  Not Found!!   ");
       TextOut(0, LCD_LINE8, "  Enter to Stop ");
       until(ButtonPressed(BTNCENTER, TRUE));
       Stop(TRUE);
     }
     
     // Connect with Slave device
     TextOut(0, LCD_LINE4, "Connecting Slave");
     
     CommExecuteFunctionType cefArgs;
     cefArgs.Cmd    = INTF_CONNECT;
     cefArgs.Param1 = idx;
     cefArgs.Param2 = BtChannel;
     
     isOK = FALSE;
     for(short xii=0; xii<20; xii++)
     {
        SysCommExecuteFunction(cefArgs);
        if(cefArgs.Result == LDR_SUCCESS)
        {
          TextOut(0, LCD_LINE4, "Connect Slave   ");
          TextOut(0, LCD_LINE5, " after   Seconds");
          for(short xjj=MUST_WAIT_3_SECONDS; xjj>0; xjj--)
          {
             NumOut(42, LCD_LINE5, xjj);
             //PlayTone(440,100);
             Wait(1000);
          }
          NumOut(42, LCD_LINE5, 0);
          //PlayTone(440,1000);
          Wait(1000);
          isOK = TRUE;
          break;
        }
        else
        {
          TextOut(0, LCD_LINE6, "Re-try:         ");
          NumOut(48, LCD_LINE6, xii);
          TextOut(0, LCD_LINE7, "Result:         ");
          NumOut(48, LCD_LINE7, cefArgs.Result);
        }
     }
     
     if(!isOK)
     {
       TextOut(0, LCD_LINE5, "    Failed!!    ");
       TextOut(0, LCD_LINE8, "  Enter to Stop ");
       until(ButtonPressed(BTNCENTER, TRUE));
       Stop(TRUE);
     }
     string remoteString;
     while(ReceiveRemoteString(MAILBOX1,TRUE,remoteString)==STAT_MSG_EMPTY_MAILBOX);
     return isOK;
}

/* ************************************************************
 * stop_Connection() function
 * ************************************************************ */
void stop_Connection(byte BtChannel)
{
     CommExecuteFunctionType cefArgs;
     cefArgs.Cmd    = INTF_DISCONNECT;
     cefArgs.Param1 = BtChannel;

     ClearScreen();
     for(short xii=0; xii<20; xii++)
     {
        SysCommExecuteFunction(cefArgs);
        if(cefArgs.Result == LDR_SUCCESS)
        {
          TextOut(0, LCD_LINE4, "Disconnect Slave");
          TextOut(0, LCD_LINE5, " after   Seconds");
          for(short xjj=MUST_WAIT_3_SECONDS; xjj>0; xjj--)
          {
             NumOut(42, LCD_LINE5, xjj);
             Wait(1000);
          }
          break;
        }
        else
        {
          TextOut(0, LCD_LINE6, "Re-try:         ");
          NumOut(48, LCD_LINE6, xii);
          TextOut(0, LCD_LINE7, "Result:         ");
          NumOut(48, LCD_LINE7, cefArgs.Result);
        }
     }
}

/* ************************************************************
 * main task
 * ************************************************************ */
task main()
{
     string remoteString;

     if(!(BluetoothStatus(BT_CHANNEL) == NO_ERR))
       build_Connection(BT_CHANNEL, ARDUINO_SLAVE);

     ClearScreen();
     TextOut(0, LCD_LINE1,"  Request Data  ");
     TextOut(0, LCD_LINE2,"  from Arduino  ");
     TextOut(0, LCD_LINE3,"  via Bluetooth ");
     TextOut(0, LCD_LINE8,"            Exit");
     while(TRUE)
     {
          TextOut(0, LCD_LINE8, "Listening.. Exit");
          //if(ReceiveRemoteString(MAILBOX1,TRUE,remoteString)!=STAT_MSG_EMPTY_MAILBOX)
          until(ReceiveRemoteString(MAILBOX1,TRUE,remoteString)==STAT_MSG_EMPTY_MAILBOX)
          {
            if(StrLen(remoteString) > 0)
            {
              TextOut(0, LCD_LINE8,"Received..  Exit");
              TextOut(0, LCD_LINE5,"                ");
              TextOut(0, LCD_LINE5,remoteString);
            }
          }
          
          Wait(50);
          if(ButtonPressed(BTNRIGHT, TRUE))
          {
            stop_Connection(BT_CHANNEL);
            Stop(TRUE);
          }
     }
}