开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > MTK > 查看源码
bt_hci_ft.cpp
资源名称：Maui_META_src_v5.0808.0.zip　[点击查看]
上传用户：gelin96
上传日期：2017-01-08
资源大小：20993k
文件大小：35k
源码类别：

MTK

开发平台：

C++ Builder

bt_hci_ft.cpp：源码内容
  1. /*****************************************************************************
  2. *  Copyright Statement:
  3. *  --------------------
  4. *  This software is protected by Copyright and the information contained
  5. *  herein is confidential. The software may not be copied and the information
  6. *  contained herein may not be used or disclosed except with the written
  7. *  permission of MediaTek Inc. (C) 2001
  8. *
  9. *****************************************************************************/
  11. /*****************************************************************************
  12.  *
  13.  * Filename:
  14.  * ---------
  15.  *   bt_hci_ft.cpp
  16.  *
  17.  * Project:
  18.  * --------
  19.  *   Maui META APP
  20.  *
  21.  * Description:
  22.  * ------------
  23.  *   BT HCI command compose/event decompose source
  24.  *
  25.  * Author:
  26.  * -------
  27.  *  Andy Ueng (mtk00490)
  28.  *
  29.  *============================================================================
  30.  *             HISTORY
  31.  * Below this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
  32.  *------------------------------------------------------------------------------
  33.  * $Revision$
  34.  * $Modtime$
  35.  * $Log$
  36.  *
  37.  *------------------------------------------------------------------------------
  38.  * Upper this line, this part is controlled by PVCS VM. DO NOT MODIFY!!
  39.  *============================================================================
  40.  ****************************************************************************/
  41. //===========================================================================
  42. #include <stdio.h>
  44. #pragma hdrstop
  46. // BT
  47. #ifndef  _BT_HCI_FT_H_
  48. #include "bt_hci_ft.h"
  49. #endif
  51. #ifndef  _BT_HCI_COMMON_H_
  52. #include "bt_hci_common.h"
  53. #endif
  56. //==============================================================================
  57. static CBTHCIFT*  gs_bt_ft_ptr;
  60. //===========================================================================
  61. CBTHCIFT::CBTHCIFT(void)
  62. {
  63. }
  65. //---------------------------------------------------------------------------
  66. CBTHCIFT::~CBTHCIFT(void)
  67. {
  68. }
  70. //===========================================================================
  71. //////////////////////////  Compose/decompose HCI command  //////////////////
  72. //===========================================================================
  73. void CBTHCIFT::Reset_HCI_Command(BT_HCI_COMMAND &hci_cmd)
  74. {
  75.     for( int i=0; i<(sizeof(hci_cmd.m_cmd)/sizeof(hci_cmd.m_cmd[0])); i++ )
  76.     {
  77.         hci_cmd.m_cmd[i] = 0;
  78.     }
  79. }
  81. //---------------------------------------------------------------------------
  82. void CBTHCIFT::Compose_Reset_HCI_Command(BT_HCI_COMMAND &hci_cmd)
  83. {
  84.     hci_cmd.m_opcode = 0x0C03;
  85.     hci_cmd.m_len    = 0x00;
  86. }
  88. //---------------------------------------------------------------------------
  89. bool CBTHCIFT::DeCompose_Reset_HCI_Event(BT_HCI_EVENT hci_event)
  90. {
  91.     if ((hci_event.m_len      != 0x04) ||
  92.         (hci_event.m_parms[0] != 0x01) ||
  93.         (hci_event.m_parms[1] != 0x03) ||
  94.         (hci_event.m_parms[2] != 0x0C) ||
  95.         (hci_event.m_parms[3] != 0x00)
  96.       )
  97.     {
  98.         return false;
  99.     }
  101.     return true;
  102. }
  103. //--------------------------------------------------------------------------
  104. void  CBTHCIFT::Compose_Read_BD_Addr_HCI_Command(BT_HCI_COMMAND &hci_cmd)
  105. {
  106.     hci_cmd.m_opcode = 0x1009;
  107.     hci_cmd.m_len    = 0;
  108.     Reset_HCI_Command( hci_cmd );
  110. }
  112. //--------------------------------------------------------------------------
  113. bool CBTHCIFT::DeCompose_Read_BD_Addr_HCI_Event(BT_HCI_EVENT hci_event, S_BD_ADDR &bd_addr)
  114. {
  115.     if ((0x09 != hci_event.m_parms[1]) ||
  116.         (0x10 != hci_event.m_parms[2]) ||
  117.         (0x00 != hci_event.m_parms[3])
  118.        )
  119.     {
  120.         return false;
  121.     }
  123.     for (int i=0; i<BD_ADDRESS_LEN; i++)
  124.     {
  125.         bd_addr.uc_BD_Addr[i] = hci_event.m_parms[4+i];
  126.     }
  127.     return true;
  128. }
  130. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  131. void  CBTHCIFT::Compose_Enter_Test_Mode_HCI_Command( BT_HCI_COMMAND &hci_cmd )
  132. {
  133.     hci_cmd.m_opcode = 0x1803;
  134.     hci_cmd.m_len    = 0;
  135.     Reset_HCI_Command( hci_cmd );
  136. }
  138. //---------------------------------------------------------------------------
  139. bool CBTHCIFT::DeCompose_Enter_Test_Mode_HCI_Event(BT_HCI_EVENT hci_event)
  140. {
  141.     if ((0x03 != hci_event.m_parms[1]) ||
  142.         (0x18 != hci_event.m_parms[2]) ||
  143.         (0x00 != hci_event.m_parms[3])
  144.        )
  145.     {
  146.         return false;
  147.     }
  149.     return true;
  150. }
  152. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  153. void  CBTHCIFT::Compose_Scan_Enable_HCI_Command( BT_HCI_COMMAND &hci_cmd )
  154. {
  155.     hci_cmd.m_opcode = 0x0C1A;
  156.     hci_cmd.m_len    = 1;
  157.     Reset_HCI_Command( hci_cmd );
  158.     hci_cmd.m_cmd[0] = 0x03;
  160. }
  162. //---------------------------------------------------------------------------
  163. bool  CBTHCIFT::DeCompose_Scan_Enable_HCI_Event(BT_HCI_EVENT hci_event)
  164. {
  165.     if ((0x1A != hci_event.m_parms[1]) ||
  166.         (0x0C != hci_event.m_parms[2]) ||
  167.         (0x00 != hci_event.m_parms[3])
  168.        )
  169.     {
  170.         return false;
  171.     }
  173.     return true;
  174. }
  176. //--------------------------------------------------------------------------
  177. void  CBTHCIFT::Compose_Auto_Accept_HCI_Command( BT_HCI_COMMAND &hci_cmd )
  178. {
  179.     hci_cmd.m_opcode = 0x0C05;
  180.     hci_cmd.m_len    = 3;
  181.     Reset_HCI_Command( hci_cmd );
  182.     hci_cmd.m_cmd[0] = 0x02;
  183.     hci_cmd.m_cmd[1] = 0x00;
  184.     hci_cmd.m_cmd[2] = 0x02;
  186. }
  188. //---------------------------------------------------------------------------
  189. bool CBTHCIFT::DeCompose_Auto_Accept_HCI_Event(BT_HCI_EVENT hci_event)
  190. {
  191.     if ((0x05 != hci_event.m_parms[1]) ||
  192.         (0x0C != hci_event.m_parms[2]) ||
  193.         (0x00 != hci_event.m_parms[3])
  194.        )
  195.     {
  196.         return false;
  197.     }
  199.     return true;
  200. }
  202. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  203. void  CBTHCIFT::Compose_ACL_Connect_HCI_Command( S_BD_ADDR &bd_addr, BT_HCI_COMMAND &hci_cmd )
  204. {
  205.     int i;
  207.     hci_cmd.m_opcode = 0x0405;
  208.     hci_cmd.m_len = 13;
  209.     Reset_HCI_Command( hci_cmd );
  210.     for( i=0; i<BD_ADDRESS_LEN; i++ )
  211.         hci_cmd.m_cmd[i] = bd_addr.uc_BD_Addr[i];
  212.     hci_cmd.m_cmd[6]  = 0x18;
  213.     hci_cmd.m_cmd[7]  = 0xCC;
  214.     hci_cmd.m_cmd[8]  = 0x01;
  215.     hci_cmd.m_cmd[9]  = 0x00;
  216.     hci_cmd.m_cmd[10] = 0xA7;
  217.     hci_cmd.m_cmd[11] = 0xFC;
  218.     hci_cmd.m_cmd[12] = 0x00;
  219.     
  222. }
  224. //---------------------------------------------------------------------------
  225. bool CBTHCIFT::DeCompose_ACL_Connect_HCI_Event1(BT_HCI_EVENT hci_event)
  226. {
  227.     if ((0x05 != hci_event.m_parms[2]) ||
  228.         (0x04 != hci_event.m_parms[3])
  229.        )
  230.     {
  231.         return false;
  232.     }
  234.     return true;
  235. }
  237. //---------------------------------------------------------------------------
  238. bool  CBTHCIFT::DeCompose_ACL_Connect_HCI_Event2(BT_HCI_EVENT hci_event, S_BD_ADDR &bd_addr, unsigned char &h1, unsigned char &h2)
  239. {
  240.     // 03 0B 00 (H1 H2) 08 FF 00 22 2D AE 01 00
  242.     if ((0x00 != hci_event.m_parms[0]) ||  // connect not successfully
  243.         (0x00 != hci_event.m_parms[2]) ||
  244.         (0x01 != hci_event.m_parms[9]) ||
  245.         (0x00 != hci_event.m_parms[10])
  246.        )
  247.     {
  248.         return false;
  249.     }
  252.     for (int i=0; i<BD_ADDRESS_LEN; i++)
  253.     {
  254.         if (bd_addr.uc_BD_Addr[i] != hci_event.m_parms[i+3])
  255.         {
  256.             return false;
  257.         }    
  258.     }
  260.     h1 = hci_event.m_parms[1];
  261.     h2 = hci_event.m_parms[2];
  264.     return true;
  265. }
  267. //---------------------------------------------------------------------------
  268. bool  CBTHCIFT::DeCompose_ACL_Connect_HCI_Event3(BT_HCI_EVENT hci_event, unsigned char &h1, unsigned char &h2 )
  269. {
  270.     // 1B 03 (H1 H2) 05
  272.     if ((0x1B != hci_event.m_parms[0]) ||
  273.         (0x03 != hci_event.m_parms[1])  ||
  274.         (0x05 != hci_event.m_parms[4])
  275.        )
  276.     {  return false;
  277.     }
  279.     h1 = hci_event.m_parms[2];
  280.     h2 = hci_event.m_parms[3];
  282.     return true;
  283. }
  285. //---------------------------------------------------------------------------
  286. bool CBTHCIFT::DeCompose_ACL_Connect_HCI_Event4(BT_HCI_EVENT hci_event, unsigned char &h1, unsigned char &h2 )
  287. {
  288.     // 1D 05 00 (H1 H2) 18 CC
  290.     if ((0x1D != hci_event.m_parms[0]) ||
  291.         (0x05 != hci_event.m_parms[1]) ||
  292.         (0x00 != hci_event.m_parms[2]) ||
  293.         (0x18 != hci_event.m_parms[5]) ||
  294.         (0xCC != hci_event.m_parms[6])
  295.        )
  296.     {
  297.         return false;
  298.     }
  300.     h1 = hci_event.m_parms[3];
  301.     h2 = hci_event.m_parms[4];
  303.     return true;
  304. }
  306. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  307. void  CBTHCIFT::Compose_TCI_Activate_Remote_DUT_HCI_Command( unsigned char h1, unsigned char h2, BT_HCI_COMMAND &hci_cmd)
  308. {
  309.     hci_cmd.m_opcode = 0xFC02;
  310.     hci_cmd.m_len = 2;
  311.     Reset_HCI_Command( hci_cmd );
  312.     hci_cmd.m_cmd[0]  = h1;
  313.     hci_cmd.m_cmd[7]  = h2;
  315. }
  317. //---------------------------------------------------------------------------
  318. bool CBTHCIFT::DeCompose_TCI_Activate_Remote_DUT_HCI_Event1(BT_HCI_EVENT hci_event)
  319. {
  320.     if ((0x02 != hci_event.m_parms[2]) ||
  321.         (0xFC != hci_event.m_parms[3])
  322.        )
  323.     {  return false;
  324.     }
  326.     return true;
  327. }
  329. //---------------------------------------------------------------------------
  330. bool CBTHCIFT::DeCompose_TCI_Activate_Remote_DUT_HCI_Event2(BT_HCI_EVENT hci_event)
  331. {
  332.     // 0E 04 01 02 FC 00
  333.     if((0x02 != hci_event.m_parms[1]) ||
  334.        (0xFC != hci_event.m_parms[2]) ||
  335.        (0x00 != hci_event.m_parms[3])
  336.        )
  337.     {
  338.         return false;
  339.     }
  341.     return true;
  342. }
  344. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  345. void  CBTHCIFT::Compose_TCI_Control_Remote_DUT_HCI_Command(unsigned char h1,
  346.                                                            unsigned char h2,
  347.                                                            S_BT_PKT_TCI req,
  348.                                                            BT_HCI_COMMAND &hci_cmd)
  349. {
  350.     // 03 FC 1B (H1 H2) 07 01 00 00 00 02 03 11 00 00 00 01 00 00 00 00 00 00 00 00 00 (N1 N2 N3 N4)
  351.     hci_cmd.m_opcode = 0xFC03;
  352.     hci_cmd.m_len    = 0x1B;
  353.     Reset_HCI_Command( hci_cmd );
  354.     hci_cmd.m_cmd[0] = h1;
  355.     hci_cmd.m_cmd[1] = h2;
  356.     hci_cmd.m_cmd[2] = 0x07;
  357.     hci_cmd.m_cmd[3] = 0x01;
  358.     hci_cmd.m_cmd[4] = 0x00;
  359.     hci_cmd.m_cmd[5] = 0x00;
  360.     hci_cmd.m_cmd[6] = 0x00;
  361.     hci_cmd.m_cmd[7] = req.uc_poll_period;
  362.    // hci_cmd.m_cmd[8] = 0x03;
  363.     hci_cmd.m_cmd[9] = req.us_packet_length & 0x00FF;
  364.     hci_cmd.m_cmd[10]= (req.us_packet_length & 0xFF00)>>8;
  365.     hci_cmd.m_cmd[11]= 0x00;
  366.     hci_cmd.m_cmd[12]= 0x00;
  367.     hci_cmd.m_cmd[13]= 0x01;
  368.     hci_cmd.m_cmd[14]= 0x00;
  369.     hci_cmd.m_cmd[15]= 0x00;
  370.     hci_cmd.m_cmd[16]= 0x00;
  371.     hci_cmd.m_cmd[17]= 0x00;
  372.     hci_cmd.m_cmd[18]= 0x00;
  373.     hci_cmd.m_cmd[19]= 0x00;
  374.     hci_cmd.m_cmd[20]= 0x00;
  375.     hci_cmd.m_cmd[21]= 0x00;
  376.     hci_cmd.m_cmd[22]= 0x00;
  377.     hci_cmd.m_cmd[23]= req.ui_packet_count & 0x000000FF;
  378.     hci_cmd.m_cmd[24]= (req.ui_packet_count & 0x0000FF00)>>8;
  379.     hci_cmd.m_cmd[25]= (req.ui_packet_count & 0x00FF0000)>>16;
  380.     hci_cmd.m_cmd[26]= (req.ui_packet_count & 0xFF000000)>>24;
  381.     switch( req.e_idx )
  382.     {
  383.         case BT_PACKET_IDX_DM1:
  384.         {
  385.             hci_cmd.m_cmd[8] = 0x03; // type
  386.         }
  387.         break;
  389.         case BT_PACKET_IDX_DH1:
  390.         {
  391.             hci_cmd.m_cmd[8] = 0x04;
  392.         }
  393.         break;
  395.         case BT_PACKET_IDX_DM3:
  396.         {
  397.             hci_cmd.m_cmd[8] = 0x0A;
  398.         }
  399.         break;
  401.         case BT_PACKET_IDX_DH3:
  402.         {
  403.             hci_cmd.m_cmd[8] = 0x0B;
  404.         }
  405.         break;
  407.         case BT_PACKET_IDX_DM5:
  408.         {
  409.             hci_cmd.m_cmd[8] = 0x0E;
  410.         }
  411.         break;
  413.         case BT_PACKET_IDX_DH5:
  414.         {
  415.             hci_cmd.m_cmd[8] = 0x0F;
  416.         }
  417.         break;
  419.         case BT_PACKET_IDX_HV1:
  420.         {
  421.             hci_cmd.m_cmd[8] = 0x05;
  422.         }
  423.         break;
  425.         case BT_PACKET_IDX_HV2:
  426.         {
  427.             hci_cmd.m_cmd[8] = 0x06;
  428.         }
  429.         break;
  431.         case BT_PACKET_IDX_HV3:
  432.         {
  433.             hci_cmd.m_cmd[8] = 0x07;
  434.         }
  435.         break;
  437.         case BT_PACKET_IDX_EV3:
  438.         {
  439.             hci_cmd.m_cmd[8] = 0x17;
  440.         }
  441.         break;
  443.         case BT_PACKET_IDX_EV4:
  444.         {
  445.             hci_cmd.m_cmd[8] = 0x1C;
  446.         }
  447.         break;
  449.         case BT_PACKET_IDX_EV5:
  450.         {
  451.             hci_cmd.m_cmd[8] = 0x1D;
  452.         }
  453.         break;
  455.         case BT_PACKET_IDX_2DH1:
  456.         {
  457.             hci_cmd.m_cmd[8] = 0x24;
  458.         }
  459.         break;
  461.         case BT_PACKET_IDX_2EV3:
  462.         {
  463.             hci_cmd.m_cmd[8] = 0x36;
  464.         }
  465.         break;
  467.         case BT_PACKET_IDX_2DH3:
  468.         {
  469.             hci_cmd.m_cmd[8] = 0x2A;
  470.         }
  471.         break;
  473.         case BT_PACKET_IDX_2EV5:
  474.         {
  475.             hci_cmd.m_cmd[8] = 0x3C;
  476.         }
  477.         break;
  479.         case BT_PACKET_IDX_2DH5:
  480.         {
  481.             hci_cmd.m_cmd[8] = 0x2E;
  482.         }
  483.         break;
  485.         case BT_PACKET_IDX_3EV3:
  486.         {
  487.             hci_cmd.m_cmd[8] = 0x37;
  488.         }
  489.         break;
  491.         case BT_PACKET_IDX_3DH1:
  492.         {
  493.             hci_cmd.m_cmd[8] = 0x28;
  494.         }
  495.         break;
  497.         case BT_PACKET_IDX_3DH3:
  498.         {
  499.             hci_cmd.m_cmd[8] = 0x2B;
  500.         }
  501.         break;
  503.         case BT_PACKET_IDX_3EV5:
  504.         {
  505.             hci_cmd.m_cmd[8] = 0x3D;
  506.         }
  507.         break;
  509.         case BT_PACKET_IDX_3DH5:
  510.         {
  511.             hci_cmd.m_cmd[8] = 0x2F;
  512.         }
  513.         break;
  514.     }
  515. }
  517. //---------------------------------------------------------------------------
  518. bool  CBTHCIFT::DeCompose_TCI_Control_Remote_DUT_HCI_Event1(BT_HCI_EVENT hci_event)
  519. {
  520.     //  0F 04 00 01 03 FC
  522.     if ((0x03 != hci_event.m_parms[1]) ||
  523.         (0xFC != hci_event.m_parms[2]) ||
  524.         (0x00 != hci_event.m_parms[3])
  525.        )
  526.     {
  527.         return false;
  528.     }
  530.     return true;
  531. }
  533. //---------------------------------------------------------------------------
  534. bool CBTHCIFT::DeCompose_TCI_Control_Remote_DUT_HCI_Event2(BT_HCI_EVENT hci_event)
  535. {
  536.     //  0E 04 01 03 FC 00
  538.     if ((0x03 != hci_event.m_parms[1]) ||
  539.         (0xFC != hci_event.m_parms[2]) ||
  540.         (0x00 != hci_event.m_parms[3])
  541.        )
  542.     {
  543.         return false;
  544.     }
  546.     return true;
  547. }
  549. #if 0
  550. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  551. void  CBTHCIFT::Compose_Enable_SCO_Connect_HCI_Command1( BT_HCI_COMMAND &hci_cmd )
  552. {
  553.    // 05,0C,01,00
  554.    hci_cmd.m_opcode = 0x0C05;
  555.    hci_cmd.m_len    = 1;
  556.    Reset_HCI_Command( hci_cmd );
  557. }
  559. //---------------------------------------------------------------------------
  560. bool  CBTHCIFT::DeCompose_Enable_SCO_Connect_HCI_Event1( BT_HCI_EVENT &hci_event )
  561. {
  562.     // 0E,04,01,05,0C,00
  564.     if(
  565.         0x05 != hci_event.m_parms[1]  ||
  566.         0x0C != hci_event.m_parms[2]  ||
  567.         0x00 != hci_event.m_parms[3]
  568.        )
  569.     {  return false;
  570.     }
  572.     return true;
  573. }
  575. //---------------------------------------------------------------------------
  576. void  CBTHCIFT::Compose_Enable_SCO_Connect_HCI_Command2( S_BD_ADDR &bd_addr, E_BT_SCO sco, BT_HCI_COMMAND &hci_cmd )
  577. {
  578.     // 29,04,15,Y1,Y2,Y3,Y4,Y5,Y6,40,1F,00,00,40,1F,00,00,05,00,AF,00,00,KK,00
  579.     hci_cmd.m_opcode = 0x0429;
  580.     hci_cmd.m_len     = 21;
  581.     Reset_HCI_Command( hci_cmd );
  582.     for( int i=0; i<BD_ADDRESS_LEN; i++ )
  583.     {
  584.         hci_cmd.m_cmd[i] = bd_addr.uc_BD_Addr[i];
  585.     }
  586.     hci_cmd.m_cmd[6]  = 0x40;
  587.     hci_cmd.m_cmd[7]  = 0x1F;
  588.     hci_cmd.m_cmd[8]  = 0x00;
  589.     hci_cmd.m_cmd[9]  = 0x00;
  590.     hci_cmd.m_cmd[10] = 0x40;
  591.     hci_cmd.m_cmd[11] = 0x1F;
  592.     hci_cmd.m_cmd[12] = 0x00;
  593.     hci_cmd.m_cmd[13] = 0x00;
  594.     hci_cmd.m_cmd[14] = 0x05;
  595.     hci_cmd.m_cmd[15] = 0x00;
  596.     hci_cmd.m_cmd[16] = 0xAF;
  597.     hci_cmd.m_cmd[17] = 0x00;
  598.     hci_cmd.m_cmd[18] = 0x00;
  599.     hci_cmd.m_cmd[19] = sco;
  600.     hci_cmd.m_cmd[20] = 0x00;
  602. }
  604. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  605. void  CBTHCIFT::Compose_Create_SCO_Connect_HCI_Command( E_BT_ACL_P1 p1, E_BT_ACL_P1 p2, E_BT_SCO sco, BT_HCI_COMMAND &hci_cmd )
  606. {
  607.    // 28,04,11,H1,H2,40,1F,00,00,40,1F,00,00,05,00,AF,00,00,KK,00
  608.    hci_cmd.m_opcode = 0x0428;
  609.    hci_cmd.m_len     = 17;
  610.    Reset_HCI_Command( hci_cmd );
  611.    hci_cmd.m_cmd[0]  = p1;
  612.    hci_cmd.m_cmd[1]  = p2;
  613.    hci_cmd.m_cmd[2]  = 0x40;
  614.    hci_cmd.m_cmd[3]  = 0x1F;
  615.    hci_cmd.m_cmd[4]  = 0x00;
  616.    hci_cmd.m_cmd[5]  = 0x00;
  617.    hci_cmd.m_cmd[6]  = 0x40;
  618.    hci_cmd.m_cmd[7]  = 0x1F;
  619.    hci_cmd.m_cmd[8]  = 0x00;
  620.    hci_cmd.m_cmd[9]  = 0x00;
  621.    hci_cmd.m_cmd[10] = 0x05;
  622.    hci_cmd.m_cmd[11] = 0x00;
  623.    hci_cmd.m_cmd[12] = 0xAF;
  624.    hci_cmd.m_cmd[13] = 0x00;
  625.    hci_cmd.m_cmd[14] = 0x00;
  626.    hci_cmd.m_cmd[15] = sco;
  627.    hci_cmd.m_cmd[16] = 0x00;
  629. }
  631. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  632. void  CBTHCIFT::Compose_Start_TX_Packet_HCI_Command( E_BT_ACL_P1 p1, E_BT_ACL_P1 p2, unsigned char poll_period,
  633.                                                    unsigned short packet_length, BT_HCI_COMMAND &hci_cmd )
  634. {
  635.     // 000: 03,FC,17,
  636.     // 003: H1,H2
  637.     // 005: scenario (01)
  638.     // 006: hop_mode (01)
  639.     // 007: tx_freq  (00)
  640.     // 008: rx_freq  (00)
  641.     // 009: power_control_mode (00)
  642.     // 010: poll_period
  643.     // 011: packet_type (P2)
  644.     // 012: packet_length
  645.     // 014: system_test_group (01,00,01,00)
  646.     // 018: system_test_subgroup (06,P1,00,00)
  647.     // 022: test_number (E8,03,00,00)
  648.     hci_cmd.m_opcode = 0xFC03;
  649.     hci_cmd.m_len     = 23;
  650.     Reset_HCI_Command( hci_cmd );
  651.     hci_cmd.m_cmd[0]  = p1;
  652.     hci_cmd.m_cmd[1]  = p2;
  653.     hci_cmd.m_cmd[2]  = 0x01;
  654.     hci_cmd.m_cmd[3]  = 0x01;
  655.     hci_cmd.m_cmd[4]  = 0x00;
  656.     hci_cmd.m_cmd[5]  = 0x00;
  657.     hci_cmd.m_cmd[6]  = 0x00;
  658.     hci_cmd.m_cmd[7]  = poll_period;
  659.     hci_cmd.m_cmd[8]  = p2;
  660.     hci_cmd.m_cmd[9]  = packet_length & 0x00FF;
  661.     hci_cmd.m_cmd[10] = (packet_length & 0xFF00) >> 8;
  662.     hci_cmd.m_cmd[11] = 0x01;
  663.     hci_cmd.m_cmd[12] = 0x00;
  664.     hci_cmd.m_cmd[13] = 0x01;
  665.     hci_cmd.m_cmd[14] = 0x00;
  666.     hci_cmd.m_cmd[15] = 0x06;
  667.     hci_cmd.m_cmd[16] = p1;
  668.     hci_cmd.m_cmd[17] = 0x00;
  669.     hci_cmd.m_cmd[18] = 0x00;
  670.     hci_cmd.m_cmd[19] = 0xE8;
  671.     hci_cmd.m_cmd[20] = 0x03;
  672.     hci_cmd.m_cmd[21] = 0x00;
  673.     hci_cmd.m_cmd[22] = 0x00;
  675. }
  677. //---------------------------------------------------------------------------
  678. bool  CBTHCIFT::DeCompose_Start_TX_Packet_HCI_Event( BT_HCI_EVENT &hci_event )
  679. {
  680.     // 0E,04,01,03,FC,00
  682.     if(
  683.         0x03 != hci_event.m_parms[1]  ||
  684.         0xFC != hci_event.m_parms[2]  ||
  685.         0x00 != hci_event.m_parms[3]
  686.        )
  687.     {  return false;
  688.     }
  690.     return true;
  691. }
  692. #endif
  695. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  696. void  CBTHCIFT::Compose_Read_TX_RX_Count_HCI_Command( BT_HCI_COMMAND &hci_cmd )
  697. {
  699.     hci_cmd.m_opcode = 0xFC3F;
  700.     hci_cmd.m_len     = 0;
  701.     Reset_HCI_Command( hci_cmd );
  702. }
  704. //---------------------------------------------------------------------------
  705. bool CBTHCIFT::DeCompose_Read_TX_RX_Count_HCI_Event(BT_HCI_EVENT hci_event, S_BT_PKT_MONITOR_TXRX_CNF &monitor )
  706. {
  707.     // 04,0E,F8,01 3F FC 00
  709.     if ((0x3F != hci_event.m_parms[1]) ||
  710.         (0xFC != hci_event.m_parms[2]) ||
  711.         (0x00 != hci_event.m_parms[3])
  712.        )
  713.     {
  714.         return false;
  715.     }
  716.     
  717.     // TX
  718.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_DM1] =  hci_event.m_parms[48]        |
  719.                                                  (hci_event.m_parms[49] << 8)  |
  720.                                                  (hci_event.m_parms[50] << 16) |
  721.                                                  (hci_event.m_parms[51] << 24) ;
  723.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_DH1] =  hci_event.m_parms[52]        |
  724.                                                  (hci_event.m_parms[53] << 8)  |
  725.                                                  (hci_event.m_parms[54] << 16) |
  726.                                                  (hci_event.m_parms[55] << 24);
  728.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_HV1] =  hci_event.m_parms[56]        |
  729.                                                  (hci_event.m_parms[57] << 8)  |
  730.                                                  (hci_event.m_parms[58] << 16) |
  731.                                                  (hci_event.m_parms[59] << 24);
  733.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_HV2] =  hci_event.m_parms[60]        |
  734.                                                  (hci_event.m_parms[61] <<  8) |
  735.                                                  (hci_event.m_parms[62] << 16) |
  736.                                                  (hci_event.m_parms[63] << 24);
  738.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_HV3] = hci_event.m_parms[64]         |
  739.                                                  (hci_event.m_parms[65] << 8)  |
  740.                                                  (hci_event.m_parms[66] << 16) |
  741.                                                  (hci_event.m_parms[67] << 24);
  743.    // monitor.ui_tx_pkt_count[BT_PACKET_IDX_DV] =  hci_event.m_parms[68]  |
  744.    //                                              (hci_event.m_parms[69] << 8) |
  745.    //                                              (hci_event.m_parms[70] << 16) |
  746.    //                                              ( hci_event.m_parms[71]<<24);
  748.    // monitor.ui_tx_pkt_count[BT_PACKET_IDX_AUX] = hci_event.m_parms[72]  |
  749.    //                                              (hci_event.m_parms[73] << 8) |
  750.    //                                              (hci_event.m_parms[74] << 16) |
  751.    //                                              (hci_event.m_parms[75] << 24);
  752.    //
  753.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_DM3] = hci_event.m_parms[76]         |
  754.                                                  (hci_event.m_parms[77] << 8)  |
  755.                                                  (hci_event.m_parms[78] << 16) |
  756.                                                  (hci_event.m_parms[79] << 24);
  758.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_DH3] = hci_event.m_parms[80]         |
  759.                                                  (hci_event.m_parms[81] << 8)  |
  760.                                                  (hci_event.m_parms[82] << 16) |
  761.                                                  (hci_event.m_parms[83] << 24);
  763.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_EV4] =  hci_event.m_parms[84]        |
  764.                                                  (hci_event.m_parms[85] << 8)  |
  765.                                                  (hci_event.m_parms[86] << 16) |
  766.                                                  (hci_event.m_parms[87] << 24);
  768.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_EV5] =  hci_event.m_parms[88]        |
  769.                                                  (hci_event.m_parms[89] << 8)  |
  770.                                                  (hci_event.m_parms[90] << 16) |
  771.                                                  (hci_event.m_parms[91] << 24);
  773.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_DM5] =  hci_event.m_parms[92]        |
  774.                                                  (hci_event.m_parms[93] << 8)  |
  775.                                                  (hci_event.m_parms[94] << 16) |
  776.                                                  (hci_event.m_parms[95] << 24);
  778.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_DH5] =  hci_event.m_parms[96]        |
  779.                                                  (hci_event.m_parms[97] <<  8) |
  780.                                                  (hci_event.m_parms[98] << 16) |
  781.                                                  (hci_event.m_parms[99] << 24);
  783.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_EV3] =  hci_event.m_parms[128]       |
  784.                                                  (hci_event.m_parms[129] <<  8)|
  785.                                                  (hci_event.m_parms[130] << 16)|
  786.                                                  (hci_event.m_parms[131] << 24);
  788.     // RX
  789.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_DM1] =  hci_event.m_parms[144]       |
  790.                                                  (hci_event.m_parms[145] << 8) |
  791.                                                  (hci_event.m_parms[146] << 16)|
  792.                                                  (hci_event.m_parms[147] << 24);
  794.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_DH1] =  hci_event.m_parms[148]       |
  795.                                                  (hci_event.m_parms[149] << 8) |
  796.                                                  (hci_event.m_parms[150] << 16)|
  797.                                                  (hci_event.m_parms[151] << 24);
  799.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_HV1] =  hci_event.m_parms[152]       |
  800.                                                  (hci_event.m_parms[153] << 8) |
  801.                                                  (hci_event.m_parms[154] << 16)|
  802.                                                  (hci_event.m_parms[155] << 24);
  804.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_HV2] =  hci_event.m_parms[156]       |
  805.                                                  (hci_event.m_parms[157] << 8) |
  806.                                                  (hci_event.m_parms[158] << 16)|
  807.                                                  (hci_event.m_parms[159] << 24);
  809.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_HV3] =  hci_event.m_parms[160]       |
  810.                                                  (hci_event.m_parms[161] <<  8)|
  811.                                                  (hci_event.m_parms[162] << 16)|
  812.                                                  (hci_event.m_parms[163] << 24);
  814.    // monitor.ui_rx_pkt_count[BT_PACKET_IDX_DV] =  hci_event.m_parms[164]  |
  815.    //                                              (hci_event.m_parms[165] << 8) |
  816.    //                                              (hci_event.m_parms[166] << 16) |
  817.    //                                              (hci_event.m_parms[167] << 24);
  819.   //  monitor.ui_rx_pkt_count[BT_PACKET_IDX_AUX] = hci_event.m_parms[168]  |
  820.   //                                               (hci_event.m_parms[169] << 8) |
  821.   //                                               (hci_event.m_parms[170] << 16) |
  822.   //                                               (hci_event.m_parms[171] << 24);
  823.   //
  824.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_DM3] = hci_event.m_parms[172]        |
  825.                                                  (hci_event.m_parms[173] << 8) |
  826.                                                  (hci_event.m_parms[174] << 16)|
  827.                                                  (hci_event.m_parms[175] << 24);
  829.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_DH3] = hci_event.m_parms[176]        |
  830.                                                  (hci_event.m_parms[177] << 8) |
  831.                                                  (hci_event.m_parms[178] << 16)|
  832.                                                  (hci_event.m_parms[179] << 24);
  834.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_EV4] = hci_event.m_parms[180]        |
  835.                                                  (hci_event.m_parms[181] << 8) |
  836.                                                  (hci_event.m_parms[182] << 16)|
  837.                                                  (hci_event.m_parms[183] << 24);
  839.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_EV5] = hci_event.m_parms[184]        |
  840.                                                  (hci_event.m_parms[185] << 8) |
  841.                                                  (hci_event.m_parms[186] << 16)|
  842.                                                  (hci_event.m_parms[187] << 24);
  844.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_DM5] =  hci_event.m_parms[188]       |
  845.                                                  (hci_event.m_parms[189] << 8) |
  846.                                                  (hci_event.m_parms[190] << 16)|
  847.                                                  (hci_event.m_parms[191] << 24);
  849.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_DH5] =  hci_event.m_parms[192]       |
  850.                                                  (hci_event.m_parms[193] << 8) |
  851.                                                  (hci_event.m_parms[194] << 16)|
  852.                                                  (hci_event.m_parms[195] << 24);
  854.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_EV3] =  hci_event.m_parms[224]       |
  855.                                                  (hci_event.m_parms[225] << 8) |
  856.                                                  (hci_event.m_parms[226] << 16)|
  857.                                                  (hci_event.m_parms[227] << 24);
  859.     return true;
  860. }
  862. //~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  863. void CBTHCIFT::Compose_Read_EDR_TX_RX_Count_HCI_Command(BT_HCI_COMMAND &hci_cmd)
  864. {
  866.     hci_cmd.m_opcode = 0xFCDA;
  867.     hci_cmd.m_len     = 0;
  868.     Reset_HCI_Command(hci_cmd);
  869. }
  871. //---------------------------------------------------------------------------
  872. bool CBTHCIFT::DeCompose_Read_EDR_TX_RX_Count_HCI_Event(BT_HCI_EVENT hci_event, S_BT_PKT_MONITOR_TXRX_CNF &monitor)
  873. {
  874.     // 04,0E,94,01,DA,FC,00
  876.     if ((0xDA != hci_event.m_parms[1]) ||
  877.         (0xFC != hci_event.m_parms[2]) ||
  878.         (0x00 != hci_event.m_parms[3])
  879.        )
  880.     {
  881.         return false;
  882.     }
  884.     // TX
  885.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_2DH1] = hci_event.m_parms[4]        |
  886.                                                  (hci_event.m_parms[5] << 8)  |
  887.                                                  (hci_event.m_parms[6] << 16) |
  888.                                                  (hci_event.m_parms[7] << 24);
  890.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_2EV3] = hci_event.m_parms[8]         |
  891.                                                  (hci_event.m_parms[9]  << 8)  |
  892.                                                  (hci_event.m_parms[10] << 16) |
  893.                                                  (hci_event.m_parms[11] << 24);
  895.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_3EV3] = hci_event.m_parms[12]        |
  896.                                                  (hci_event.m_parms[13] << 8)  |
  897.                                                  (hci_event.m_parms[14] << 16) |
  898.                                                  (hci_event.m_parms[15] << 24);
  900.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_3DH1] = hci_event.m_parms[16]        |
  901.                                                  (hci_event.m_parms[17] <<  8) |
  902.                                                  (hci_event.m_parms[18] << 16) |
  903.                                                  (hci_event.m_parms[19] << 24);
  905.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_2DH3] = hci_event.m_parms[20]         |
  906.                                                  (hci_event.m_parms[21] << 8)  |
  907.                                                  (hci_event.m_parms[22] << 16) |
  908.                                                  (hci_event.m_parms[23] << 24);
  910.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_3DH3] = hci_event.m_parms[24]        |
  911.                                                  (hci_event.m_parms[25] << 8)  |
  912.                                                  (hci_event.m_parms[26] << 16) |
  913.                                                  (hci_event.m_parms[27] << 24);
  915.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_2EV5] = hci_event.m_parms[28]         |
  916.                                                  (hci_event.m_parms[29] << 8)  |
  917.                                                  (hci_event.m_parms[30] << 16) |
  918.                                                  (hci_event.m_parms[31] << 24);
  920.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_3EV5] = hci_event.m_parms[32]        |
  921.                                                  (hci_event.m_parms[33] << 8)  |
  922.                                                  (hci_event.m_parms[34] << 16) |
  923.                                                  (hci_event.m_parms[35] << 24);
  925.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_2DH5] = hci_event.m_parms[36]        |
  926.                                                  (hci_event.m_parms[37] << 8)  |
  927.                                                  (hci_event.m_parms[38] << 16) |
  928.                                                  (hci_event.m_parms[39] << 24);
  930.     monitor.ui_tx_pkt_count[BT_PACKET_IDX_3DH5] = hci_event.m_parms[40]        |
  931.                                                  (hci_event.m_parms[41] << 8)  |
  932.                                                  (hci_event.m_parms[42] << 16) |
  933.                                                  (hci_event.m_parms[43] << 24);
  935.     // RX
  936.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_2DH1] = hci_event.m_parms[64]        |
  937.                                                  (hci_event.m_parms[65] << 8)  |
  938.                                                  (hci_event.m_parms[66] << 16) |
  939.                                                  (hci_event.m_parms[67] << 24);
  941.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_2EV3] = hci_event.m_parms[68]         |
  942.                                                  (hci_event.m_parms[69]  << 8)  |
  943.                                                  (hci_event.m_parms[70] << 16) |
  944.                                                  (hci_event.m_parms[71] << 24);
  946.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_3EV3] = hci_event.m_parms[72]        |
  947.                                                  (hci_event.m_parms[73] << 8)  |
  948.                                                  (hci_event.m_parms[74] << 16) |
  949.                                                  (hci_event.m_parms[75] << 24);
  951.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_3DH1] = hci_event.m_parms[76]        |
  952.                                                  (hci_event.m_parms[77] <<  8) |
  953.                                                  (hci_event.m_parms[78] << 16) |
  954.                                                  (hci_event.m_parms[79] << 24);
  956.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_2DH3] = hci_event.m_parms[80]         |
  957.                                                  (hci_event.m_parms[81] << 8)  |
  958.                                                  (hci_event.m_parms[82] << 16) |
  959.                                                  (hci_event.m_parms[83] << 24);
  961.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_3DH3] = hci_event.m_parms[84]        |
  962.                                                  (hci_event.m_parms[85] << 8)  |
  963.                                                  (hci_event.m_parms[86] << 16) |
  964.                                                  (hci_event.m_parms[87] << 24);
  966.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_2EV5] = hci_event.m_parms[88]         |
  967.                                                  (hci_event.m_parms[89] << 8)  |
  968.                                                  (hci_event.m_parms[90] << 16) |
  969.                                                  (hci_event.m_parms[91] << 24);
  971.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_3EV5] = hci_event.m_parms[92]        |
  972.                                                  (hci_event.m_parms[93] << 8)  |
  973.                                                  (hci_event.m_parms[94] << 16) |
  974.                                                  (hci_event.m_parms[95] << 24);
  976.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_2DH5] = hci_event.m_parms[96]        |
  977.                                                  (hci_event.m_parms[97] << 8)  |
  978.                                                  (hci_event.m_parms[98] << 16) |
  979.                                                  (hci_event.m_parms[99] << 24);
  981.     monitor.ui_rx_pkt_count[BT_PACKET_IDX_3DH5] = hci_event.m_parms[100]        |
  982.                                                  (hci_event.m_parms[101] << 8)  |
  983.                                                  (hci_event.m_parms[102] << 16) |
  984.                                                  (hci_event.m_parms[103] << 24);
  986.     return true;
  987. }