/*
Program  ID: NXTcommM01.nxc
Create Date: 2009-5-20
NXT BT LCP testing/Master side
*/

#define BT_CHANNEL    1
#define SLAVE_DEVICE  "CH_NXT_B"
#define SLAVE_PROGRAM "NRLink-8183CPM3.rxe"

/* ********************************************************
 * Search slave device index on My contacts list, then
 * establish connection
 * ******************************************************** */
bool Build_Connection(byte BtChannel, const string BtDevname)
{
     string msg;
     bool isOK = FALSE;
     byte idx  = 0;

     ClearScreen();
     TextOut(0, LCD_LINE1,StrCat("Search " ,BtDevname,"        " ));
     TextOut(0, LCD_LINE2,"in My Contact   " );
     for (byte xii=0; xii<BTDeviceCount(); xii++)
     {
         msg = BTDeviceName(xii);
         TextOut(0, LCD_LINE3, StrCat("Table: " ,msg,"         " ));
         if (BTDeviceName(xii) == BtDevname)
         {
            idx  = xii;
            isOK = TRUE;
            break;
         }
     }

     if (!isOK)
     {
        TextOut(0, LCD_LINE4, "Not in MyContact" );
        TextOut(0, LCD_LINE8, "Enter to Exit   " );
        until (ButtonPressed(BTNCENTER, TRUE));
        return FALSE;
     }
     
     msg = NumToStr(BtChannel);
     ClearScreen();
     TextOut(0, LCD_LINE1,StrCat("Connect " ,BtDevname));
     TextOut(0, LCD_LINE2,StrCat("on channel " ,msg));
     
     // Using Comm module IOMAP accessing method to establish connection
     // see NXC Programmer's Guide P39
     CommExecuteFunctionType cefArgs;
     cefArgs.Cmd    = INTF_CONNECT;
     cefArgs.Param1 = idx;
     cefArgs.Param2 = BtChannel;
     
     isOK  = FALSE;
     for (byte xii=0; xii<20; xii++)
     {
         msg = NumToStr(xii);
         TextOut(0, LCD_LINE3, StrCat("Try " , msg));
         SysCommExecuteFunction(cefArgs);
         Wait(500);
         
         msg = NumToStr(cefArgs.Result);
         TextOut(0, LCD_LINE4, StrCat("Result: " , msg,"       " ));
         if (cefArgs.Result == LDR_SUCCESS)
         {
            isOK = TRUE;
            break;
         }
     }
     if (!isOK)
     {
        TextOut(0, LCD_LINE4, "Connect failed  " );
        TextOut(0, LCD_LINE5, "Check Slave !   " );
        TextOut(0, LCD_LINE8, "Enter to Exit   " );
        until (ButtonPressed(BTNCENTER, TRUE));
     }
     return isOK;
}
/* ********************************************************
 * Verify wether connection ready, if not establish it
 * ******************************************************** */
bool Check_Connection(byte BtChannel, const string BtDevname)
{
     bool isOK = FALSE;

     ClearScreen();
     TextOut(0, LCD_LINE1,"Check connection" );
     if (BluetoothStatus(BtChannel) == NO_ERR)        isOK = TRUE;
     else if (Build_Connection(BtChannel, BtDevname)) isOK = TRUE;
          else
          {
              ClearScreen();
              TextOut(0, LCD_LINE1,"Cannot connect  " );
              TextOut(0, LCD_LINE2,"    with Slave  " );
              TextOut(0, LCD_LINE8,"Enter to Exit   " );
              until (ButtonPressed(BTNCENTER, TRUE));
          }
     return isOK;
}
/* ********************************************************
 *
 * ******************************************************** */
task main()
{
     if (Check_Connection(BT_CHANNEL, SLAVE_DEVICE))
     {
        ClearScreen();
        TextOut(0, LCD_LINE1,"Connect OK      " );
        TextOut(0, LCD_LINE8,"Enter to Run Rmt" );
        until (ButtonPressed(BTNCENTER, TRUE));
        
        RemoteStartProgram(BT_CHANNEL, SLAVE_PROGRAM);

        ClearScreen();
        TextOut(0, LCD_LINE1,StrCat("Run ",SLAVE_PROGRAM),"           " );
        TextOut(0, LCD_LINE8,"Enter to Exit   " );
        until (ButtonPressed(BTNCENTER, TRUE));
     }
}