/****************************************************************************** * * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify it * under the terms of version 2 of the GNU General Public License as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * * You should have received a copy of the GNU General Public License along with * this program; if not, write to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA * * ******************************************************************************/ #include #include #if defined(CONFIG_RTL8723B) #include #endif #if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8821A) void MPh2c_timeout_handle(void *FunctionContext) { PADAPTER pAdapter; PMPT_CONTEXT pMptCtx; DBG_8192C("[MPT], MPh2c_timeout_handle \n"); pAdapter = (PADAPTER)FunctionContext; pMptCtx = &pAdapter->mppriv.MptCtx; pMptCtx->bMPh2c_timeout = _TRUE; if ((_FALSE == pMptCtx->MptH2cRspEvent) || ((_TRUE == pMptCtx->MptH2cRspEvent) && (_FALSE == pMptCtx->MptBtC2hEvent))) { _rtw_up_sema(&pMptCtx->MPh2c_Sema); } } u32 WaitC2Hevent(PADAPTER pAdapter, u8 *C2H_event, u32 delay_time) { PMPT_CONTEXT pMptCtx=&(pAdapter->mppriv.MptCtx); pMptCtx->bMPh2c_timeout=_FALSE; if( pAdapter->registrypriv.mp_mode == 0 ) { DBG_8192C("[MPT], Error!! WaitC2Hevent mp_mode == 0!!\n"); return _FALSE; } _set_timer( &pMptCtx->MPh2c_timeout_timer, delay_time ); _rtw_down_sema(&pMptCtx->MPh2c_Sema); if (pMptCtx->bMPh2c_timeout == _TRUE) { *C2H_event = _FALSE; return _FALSE; } // for safty, cancel timer here again _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); return _TRUE; } BT_CTRL_STATUS mptbt_CheckC2hFrame( PADAPTER Adapter, PBT_H2C pH2c, PBT_EXT_C2H pExtC2h ) { BT_CTRL_STATUS c2hStatus = BT_STATUS_C2H_SUCCESS; //DBG_8192C("[MPT], MPT rsp C2H hex: %x %x %x %x %x %x \n"), pExtC2h , pExtC2h+1 ,pExtC2h+2 ,pExtC2h+3 ,pExtC2h+4 ,pExtC2h+5); DBG_8192C("[MPT], statusCode = 0x%x\n", pExtC2h->statusCode); DBG_8192C("[MPT], retLen = %d\n", pExtC2h->retLen); DBG_8192C("[MPT], opCodeVer : req/rsp=%d/%d\n", pH2c->opCodeVer, pExtC2h->opCodeVer); DBG_8192C("[MPT], reqNum : req/rsp=%d/%d\n", pH2c->reqNum, pExtC2h->reqNum); if(pExtC2h->reqNum != pH2c->reqNum) { c2hStatus = BT_STATUS_C2H_REQNUM_MISMATCH; DBG_8192C("[MPT], Error!! C2H reqNum Mismatch!!\n"); } else if(pExtC2h->opCodeVer != pH2c->opCodeVer) { c2hStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; DBG_8192C("[MPT], Error!! OPCode version L mismatch!!\n"); } return c2hStatus; } BT_CTRL_STATUS mptbt_SendH2c( PADAPTER Adapter, PBT_H2C pH2c, u2Byte h2cCmdLen ) { //KIRQL OldIrql = KeGetCurrentIrql(); BT_CTRL_STATUS h2cStatus=BT_STATUS_H2C_SUCCESS; PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); u1Byte i; DBG_8192C("[MPT], mptbt_SendH2c()=========>\n"); //PlatformResetEvent(&pMptCtx->MptH2cRspEvent); //PlatformResetEvent(&pMptCtx->MptBtC2hEvent); // if(OldIrql == PASSIVE_LEVEL) // { //RTPRINT_DATA(FMPBT, FMPBT_H2C_CONTENT, ("[MPT], MPT H2C hex: \n"), pH2c, h2cCmdLen); for(i=0; iMptH2cRspEvent = _FALSE; pMptCtx->MptBtC2hEvent = _FALSE; #if defined(CONFIG_RTL8723B) rtl8723b_set_FwBtMpOper_cmd(Adapter, pH2c->opCode, pH2c->opCodeVer, pH2c->reqNum, pH2c->buf); #endif pMptCtx->h2cReqNum++; pMptCtx->h2cReqNum %= 16; if(WaitC2Hevent(Adapter, &pMptCtx->MptH2cRspEvent, 100)) { DBG_8192C("[MPT], Received WiFi MptH2cRspEvent!!!\n"); if(WaitC2Hevent(Adapter, &pMptCtx->MptBtC2hEvent, 400)) { DBG_8192C("[MPT], Received MptBtC2hEvent!!!\n"); break; } else { DBG_8192C("[MPT], Error!!BT MptBtC2hEvent timeout!!\n"); h2cStatus = BT_STATUS_H2C_BT_NO_RSP; } } else { DBG_8192C("[MPT], Error!!WiFi MptH2cRspEvent timeout!!\n"); h2cStatus = BT_STATUS_H2C_TIMTOUT; } } // } // else // { // RT_ASSERT(FALSE, ("[MPT], mptbt_SendH2c() can only run under PASSIVE_LEVEL!!\n")); // h2cStatus = BT_STATUS_WRONG_LEVEL; // } DBG_8192C("[MPT], mptbt_SendH2c()<=========\n"); return h2cStatus; } BT_CTRL_STATUS mptbt_CheckBtRspStatus( PADAPTER Adapter, PBT_EXT_C2H pExtC2h ) { BT_CTRL_STATUS retStatus=BT_OP_STATUS_SUCCESS; switch(pExtC2h->statusCode) { case BT_OP_STATUS_SUCCESS: retStatus = BT_STATUS_BT_OP_SUCCESS; DBG_8192C("[MPT], BT status : BT_STATUS_SUCCESS\n"); break; case BT_OP_STATUS_VERSION_MISMATCH: retStatus = BT_STATUS_OPCODE_L_VERSION_MISMATCH; DBG_8192C("[MPT], BT status : BT_STATUS_OPCODE_L_VERSION_MISMATCH\n"); break; case BT_OP_STATUS_UNKNOWN_OPCODE: retStatus = BT_STATUS_UNKNOWN_OPCODE_L; DBG_8192C("[MPT], BT status : BT_STATUS_UNKNOWN_OPCODE_L\n"); break; case BT_OP_STATUS_ERROR_PARAMETER: retStatus = BT_STATUS_PARAMETER_FORMAT_ERROR_L; DBG_8192C("[MPT], BT status : BT_STATUS_PARAMETER_FORMAT_ERROR_L\n"); break; default: retStatus = BT_STATUS_UNKNOWN_STATUS_L; DBG_8192C("[MPT], BT status : BT_STATUS_UNKNOWN_STATUS_L\n"); break; } return retStatus; } BT_CTRL_STATUS mptbt_BtFwOpCodeProcess( PADAPTER Adapter, u1Byte btFwOpCode, u1Byte opCodeVer, pu1Byte pH2cPar, u1Byte h2cParaLen ) { u1Byte H2C_Parameter[6] ={0}; PBT_H2C pH2c=(PBT_H2C)&H2C_Parameter[0]; PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; u2Byte paraLen=0,i; BT_CTRL_STATUS h2cStatus=BT_STATUS_H2C_SUCCESS, c2hStatus=BT_STATUS_C2H_SUCCESS; BT_CTRL_STATUS retStatus=BT_STATUS_H2C_BT_NO_RSP; if( Adapter->registrypriv.mp_mode == 0 ) { DBG_8192C("[MPT], Error!! mptbt_BtFwOpCodeProces mp_mode == 0!!\n"); return _FALSE; } pH2c->opCode = btFwOpCode; pH2c->opCodeVer = opCodeVer; pH2c->reqNum = pMptCtx->h2cReqNum; //PlatformMoveMemory(&pH2c->buf[0], pH2cPar, h2cParaLen); //_rtw_memcpy(&pH2c->buf[0], pH2cPar, h2cParaLen); _rtw_memcpy(pH2c->buf, pH2cPar, h2cParaLen); DBG_8192C("[MPT], pH2c->opCode=%d\n", pH2c->opCode); DBG_8192C("[MPT], pH2c->opCodeVer=%d\n", pH2c->opCodeVer); DBG_8192C("[MPT], pH2c->reqNum=%d\n", pH2c->reqNum); DBG_8192C("[MPT], h2c parameter length=%d\n", h2cParaLen); for (i=0; ibuf[i]); } h2cStatus = mptbt_SendH2c(Adapter, pH2c, h2cParaLen+2); if(BT_STATUS_H2C_SUCCESS == h2cStatus) { // if reach here, it means H2C get the correct c2h response, c2hStatus = mptbt_CheckC2hFrame(Adapter, pH2c, pExtC2h); if(BT_STATUS_C2H_SUCCESS == c2hStatus) { retStatus = mptbt_CheckBtRspStatus(Adapter, pExtC2h); } else { DBG_8192C("[MPT], Error!! C2H failed for pH2c->opCode=%d\n", pH2c->opCode); // check c2h status error, return error status code to upper layer. retStatus = c2hStatus; } } else { DBG_8192C("[MPT], Error!! H2C failed for pH2c->opCode=%d\n", pH2c->opCode); // check h2c status error, return error status code to upper layer. retStatus = h2cStatus; } return retStatus; } u2Byte mptbt_BtReady( PADAPTER Adapter, PBT_REQ_CMD pBtReq, PBT_RSP_CMD pBtRsp ) { u1Byte h2cParaBuf[6] ={0}; u1Byte h2cParaLen=0; u2Byte paraLen=0; u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode; u1Byte btOpcodeVer=0; PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; u1Byte i; u1Byte btFwVer=0, bdAddr[6]={0}; u2Byte btRealFwVer=0; pu2Byte pu2Tmp=NULL; // // check upper layer parameters // // 1. check upper layer opcode version if(pBtReq->opCodeVer != 1) { DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; return paraLen; } pBtRsp->pParamStart[0] = MP_BT_NOT_READY; paraLen = 10; // // execute lower layer opcodes // // Get BT FW version // fill h2c parameters btOpcode = BT_LO_OP_GET_BT_VERSION; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } else { pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; btRealFwVer = *pu2Tmp; btFwVer = pExtC2h->buf[1]; DBG_8192C("[MPT], btRealFwVer=0x%x, btFwVer=0x%x\n", btRealFwVer, btFwVer); } // Get BD Address // fill h2c parameters btOpcode = BT_LO_OP_GET_BD_ADDR_L; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } else { bdAddr[5] = pExtC2h->buf[0]; bdAddr[4] = pExtC2h->buf[1]; bdAddr[3] = pExtC2h->buf[2]; } // fill h2c parameters btOpcode = BT_LO_OP_GET_BD_ADDR_H; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } else { bdAddr[2] = pExtC2h->buf[0]; bdAddr[1] = pExtC2h->buf[1]; bdAddr[0] = pExtC2h->buf[2]; } DBG_8192C("[MPT], Local BDAddr:"); for(i=0; i<6; i++) { DBG_8192C(" 0x%x ", bdAddr[i]); } pBtRsp->status = BT_STATUS_SUCCESS; pBtRsp->pParamStart[0] = MP_BT_READY; pu2Tmp = (pu2Byte)&pBtRsp->pParamStart[1]; *pu2Tmp = btRealFwVer; pBtRsp->pParamStart[3] = btFwVer; for(i=0; i<6; i++) { pBtRsp->pParamStart[4+i] = bdAddr[5-i]; } return paraLen; } void mptbt_close_WiFiRF(PADAPTER Adapter) { PHY_SetBBReg(Adapter, 0x824, 0xF, 0x0); PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x0); PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x0); } void mptbt_open_WiFiRF(PADAPTER Adapter) { PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x3); PHY_SetBBReg(Adapter, 0x824, 0xF, 0x2); PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); } u4Byte mptbt_switch_RF(PADAPTER Adapter, u1Byte Enter) { u2Byte tmp_2byte = 0; //Enter test mode if (Enter) { ////1>. close WiFi RF mptbt_close_WiFiRF(Adapter); ////2>. change ant switch to BT tmp_2byte = rtw_read16(Adapter, 0x860); tmp_2byte = tmp_2byte | BIT(9); tmp_2byte = tmp_2byte & (~BIT(8)); rtw_write16(Adapter, 0x860, tmp_2byte); rtw_write16(Adapter, 0x870, 0x300); } else { ////1>. Open WiFi RF mptbt_open_WiFiRF(Adapter); ////2>. change ant switch back tmp_2byte = rtw_read16(Adapter, 0x860); tmp_2byte = tmp_2byte | BIT(8); tmp_2byte = tmp_2byte & (~BIT(9)); rtw_write16(Adapter, 0x860, tmp_2byte); rtw_write16(Adapter, 0x870, 0x300); } return 0; } u2Byte mptbt_BtSetMode( PADAPTER Adapter, PBT_REQ_CMD pBtReq, PBT_RSP_CMD pBtRsp ) { u1Byte h2cParaBuf[6] ={0}; u1Byte h2cParaLen=0; u2Byte paraLen=0; u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode; u1Byte btOpcodeVer=0; u1Byte btModeToSet=0; // // check upper layer parameters // // 1. check upper layer opcode version if(pBtReq->opCodeVer != 1) { DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; return paraLen; } // 2. check upper layer parameter length if(1 == pBtReq->paraLength) { btModeToSet = pBtReq->pParamStart[0]; DBG_8192C("[MPT], BtTestMode=%d \n", btModeToSet); } else { DBG_8192C("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; return paraLen; } // // execute lower layer opcodes // // 1. fill h2c parameters // check bt mode btOpcode = BT_LO_OP_SET_BT_MODE; if(btModeToSet >= MP_BT_MODE_MAX) { pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { mptbt_switch_RF(Adapter, 1); h2cParaBuf[0] = btModeToSet; h2cParaLen = 1; // 2. execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // 3. construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS == retStatus) { pBtRsp->status = BT_STATUS_SUCCESS; } else { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); } return paraLen; } VOID MPTBT_FwC2hBtMpCtrl( PADAPTER Adapter, pu1Byte tmpBuf, u1Byte length ) { u32 i; PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)tmpBuf; if(Adapter->bBTFWReady == _FALSE || Adapter->registrypriv.mp_mode == 0 ) { //DBG_8192C("Ignore C2H BT MP Info since not in MP mode \n"); return; } if( length > 32 || length < 3 ) { DBG_8192C("\n [MPT], pExtC2h->buf hex: length=%d > 32 || < 3\n",length); return; } //cancel_timeout for h2c handle _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); for (i=0; iextendId=0x%x\n", pExtC2h->extendId); switch(pExtC2h->extendId) { case EXT_C2H_WIFI_FW_ACTIVE_RSP: DBG_8192C("[MPT], EXT_C2H_WIFI_FW_ACTIVE_RSP\n"); #if 0 DBG_8192C("[MPT], pExtC2h->buf hex: \n"); for (i=0; i<(length-3); i++) { DBG_8192C(" 0x%x ", pExtC2h->buf[i]); } #endif if ((_FALSE == pMptCtx->bMPh2c_timeout) && (_FALSE == pMptCtx->MptH2cRspEvent)) { pMptCtx->MptH2cRspEvent = _TRUE; _rtw_up_sema(&pMptCtx->MPh2c_Sema); } break; case EXT_C2H_TRIG_BY_BT_FW: DBG_8192C("[MPT], EXT_C2H_TRIG_BY_BT_FW\n"); _rtw_memcpy(&pMptCtx->c2hBuf[0], tmpBuf, length); DBG_8192C("[MPT], pExtC2h->statusCode=0x%x\n", pExtC2h->statusCode); DBG_8192C("[MPT], pExtC2h->retLen=0x%x\n", pExtC2h->retLen); DBG_8192C("[MPT], pExtC2h->opCodeVer=0x%x\n", pExtC2h->opCodeVer); DBG_8192C("[MPT], pExtC2h->reqNum=0x%x\n", pExtC2h->reqNum); for (i=0; i<(length-3); i++) { DBG_8192C("[MPT], pExtC2h->buf[%d]=0x%02x\n", i, pExtC2h->buf[i]); } if ((_FALSE == pMptCtx->bMPh2c_timeout) && (_TRUE == pMptCtx->MptH2cRspEvent) && (_FALSE == pMptCtx->MptBtC2hEvent)) { pMptCtx->MptBtC2hEvent = _TRUE; _rtw_up_sema(&pMptCtx->MPh2c_Sema); } break; default: DBG_8192C("[MPT], EXT_C2H Target not found,pExtC2h->extendId =%d ,pExtC2h->reqNum=%d\n",pExtC2h->extendId,pExtC2h->reqNum); break; } } u2Byte mptbt_BtGetGeneral( IN PADAPTER Adapter, IN PBT_REQ_CMD pBtReq, IN PBT_RSP_CMD pBtRsp ) { PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); PBT_EXT_C2H pExtC2h=(PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; u1Byte h2cParaBuf[6] ={0}; u1Byte h2cParaLen=0; u2Byte paraLen=0; u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode, bdAddr[6]={0}; u1Byte btOpcodeVer=0; u1Byte getType=0, i; u2Byte getParaLen=0, validParaLen=0; u1Byte regType=0, reportType=0; u4Byte regAddr=0, regValue=0; pu4Byte pu4Tmp; pu2Byte pu2Tmp; pu1Byte pu1Tmp; // // check upper layer parameters // // check upper layer opcode version if(pBtReq->opCodeVer != 1) { DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; return paraLen; } // check upper layer parameter length if(pBtReq->paraLength < 1) { DBG_8192C("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; return paraLen; } getParaLen = pBtReq->paraLength - 1; getType = pBtReq->pParamStart[0]; DBG_8192C("[MPT], getType=%d, getParaLen=%d\n", getType, getParaLen); // check parameter first switch(getType) { case BT_GGET_REG: DBG_8192C("[MPT], [BT_GGET_REG]\n"); validParaLen = 5; if(getParaLen == validParaLen) { btOpcode = BT_LO_OP_READ_REG; regType = pBtReq->pParamStart[1]; pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; regAddr = *pu4Tmp; DBG_8192C("[MPT], BT_GGET_REG regType=0x%02x, regAddr=0x%08x!!\n", regType, regAddr); if(regType >= BT_REG_MAX) { pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { if( ((BT_REG_RF==regType)&&(regAddr>0x7f)) || ((BT_REG_MODEM==regType)&&(regAddr>0x1ff)) || ((BT_REG_BLUEWIZE==regType)&&(regAddr>0xfff)) || ((BT_REG_VENDOR==regType)&&(regAddr>0xfff)) || ((BT_REG_LE==regType)&&(regAddr>0xfff)) ) { pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } } } break; case BT_GGET_STATUS: DBG_8192C("[MPT], [BT_GGET_STATUS]\n"); validParaLen = 0; break; case BT_GGET_REPORT: DBG_8192C("[MPT], [BT_GGET_REPORT]\n"); validParaLen = 1; if(getParaLen == validParaLen) { reportType = pBtReq->pParamStart[1]; DBG_8192C("[MPT], BT_GGET_REPORT reportType=0x%x!!\n", reportType); if(reportType >= BT_REPORT_MAX) { pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } } break; default: { DBG_8192C("[MPT], Error!! getType=%d, out of range\n", getType); pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } break; } if(getParaLen != validParaLen) { DBG_8192C("[MPT], Error!! wrong parameter length=%d for BT_GET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", getParaLen, getType, validParaLen); pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; return paraLen; } // // execute lower layer opcodes // if(BT_GGET_REG == getType) { // fill h2c parameters // here we should write reg value first then write the address, adviced by Austin btOpcode = BT_LO_OP_READ_REG; h2cParaBuf[0] = regType; h2cParaBuf[1] = pBtReq->pParamStart[2]; h2cParaBuf[2] = pBtReq->pParamStart[3]; h2cParaLen = 3; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; regValue = *pu2Tmp; DBG_8192C("[MPT], read reg regType=0x%02x, regAddr=0x%08x, regValue=0x%04x\n", regType, regAddr, regValue); pu4Tmp = (pu4Byte)&pBtRsp->pParamStart[0]; *pu4Tmp = regValue; paraLen = 4; } else if(BT_GGET_STATUS == getType) { btOpcode = BT_LO_OP_GET_BT_STATUS; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[0] = pExtC2h->buf[0]; pBtRsp->pParamStart[1] = pExtC2h->buf[1]; DBG_8192C("[MPT], read bt status, testMode=0x%x, testStatus=0x%x\n", pBtRsp->pParamStart[0], pBtRsp->pParamStart[1]); paraLen = 2; } else if(BT_GGET_REPORT == getType) { switch(reportType) { case BT_REPORT_RX_PACKET_CNT: { DBG_8192C("[MPT], [Rx Packet Counts]\n"); btOpcode = BT_LO_OP_GET_RX_PKT_CNT_L; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[0] = pExtC2h->buf[0]; pBtRsp->pParamStart[1] = pExtC2h->buf[1]; btOpcode = BT_LO_OP_GET_RX_PKT_CNT_H; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[2] = pExtC2h->buf[0]; pBtRsp->pParamStart[3] = pExtC2h->buf[1]; paraLen = 4; } break; case BT_REPORT_RX_ERROR_BITS: { DBG_8192C("[MPT], [Rx Error Bits]\n"); btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_L; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[0] = pExtC2h->buf[0]; pBtRsp->pParamStart[1] = pExtC2h->buf[1]; btOpcode = BT_LO_OP_GET_RX_ERROR_BITS_H; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[2] = pExtC2h->buf[0]; pBtRsp->pParamStart[3] = pExtC2h->buf[1]; paraLen = 4; } break; case BT_REPORT_RSSI: { DBG_8192C("[MPT], [RSSI]\n"); btOpcode = BT_LO_OP_GET_RSSI; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[0] = pExtC2h->buf[0]; pBtRsp->pParamStart[1] = pExtC2h->buf[1]; paraLen = 2; } break; case BT_REPORT_CFO_HDR_QUALITY: { DBG_8192C("[MPT], [CFO & Header Quality]\n"); btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_L; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[0] = pExtC2h->buf[0]; pBtRsp->pParamStart[1] = pExtC2h->buf[1]; btOpcode = BT_LO_OP_GET_CFO_HDR_QUALITY_H; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->pParamStart[2] = pExtC2h->buf[0]; pBtRsp->pParamStart[3] = pExtC2h->buf[1]; paraLen = 4; } break; case BT_REPORT_CONNECT_TARGET_BD_ADDR: { DBG_8192C("[MPT], [Connected Target BD ADDR]\n"); btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_L; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } bdAddr[5] = pExtC2h->buf[0]; bdAddr[4] = pExtC2h->buf[1]; bdAddr[3] = pExtC2h->buf[2]; btOpcode = BT_LO_OP_GET_TARGET_BD_ADDR_H; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } bdAddr[2] = pExtC2h->buf[0]; bdAddr[1] = pExtC2h->buf[1]; bdAddr[0] = pExtC2h->buf[2]; DBG_8192C("[MPT], Connected Target BDAddr:%s", bdAddr); for(i=0; i<6; i++) { pBtRsp->pParamStart[i] = bdAddr[5-i]; } paraLen = 6; } break; default: pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; break; } } pBtRsp->status = BT_STATUS_SUCCESS; return paraLen; } u2Byte mptbt_BtSetGeneral( IN PADAPTER Adapter, IN PBT_REQ_CMD pBtReq, IN PBT_RSP_CMD pBtRsp ) { u1Byte h2cParaBuf[6] ={0}; u1Byte h2cParaLen=0; u2Byte paraLen=0; u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode; u1Byte btOpcodeVer=0; u1Byte setType=0; u2Byte setParaLen=0, validParaLen=0; u1Byte regType=0, bdAddr[6]={0}, calVal=0; u4Byte regAddr=0, regValue=0; pu4Byte pu4Tmp; pu2Byte pu2Tmp; pu1Byte pu1Tmp; // // check upper layer parameters // // check upper layer opcode version if(pBtReq->opCodeVer != 1) { DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; return paraLen; } // check upper layer parameter length if(pBtReq->paraLength < 1) { DBG_8192C("[MPT], Error!! wrong parameter length=%d (should larger than 1)\n", pBtReq->paraLength); pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; return paraLen; } setParaLen = pBtReq->paraLength - 1; setType = pBtReq->pParamStart[0]; DBG_8192C("[MPT], setType=%d, setParaLen=%d\n", setType, setParaLen); // check parameter first switch(setType) { case BT_GSET_REG: DBG_8192C ("[MPT], [BT_GSET_REG]\n"); validParaLen = 9; if(setParaLen == validParaLen) { btOpcode = BT_LO_OP_WRITE_REG_VALUE; regType = pBtReq->pParamStart[1]; pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; regAddr = *pu4Tmp; pu4Tmp = (pu4Byte)&pBtReq->pParamStart[6]; regValue = *pu4Tmp; DBG_8192C("[MPT], BT_GSET_REG regType=0x%x, regAddr=0x%x, regValue=0x%x!!\n", regType, regAddr, regValue); if(regType >= BT_REG_MAX) { pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { if( ((BT_REG_RF==regType)&&(regAddr>0x7f)) || ((BT_REG_MODEM==regType)&&(regAddr>0x1ff)) || ((BT_REG_BLUEWIZE==regType)&&(regAddr>0xfff)) || ((BT_REG_VENDOR==regType)&&(regAddr>0xfff)) || ((BT_REG_LE==regType)&&(regAddr>0xfff)) ) { pBtRsp->status = (btOpcode<<8)| BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } } } break; case BT_GSET_RESET: DBG_8192C("[MPT], [BT_GSET_RESET]\n"); validParaLen = 0; break; case BT_GSET_TARGET_BD_ADDR: DBG_8192C("[MPT], [BT_GSET_TARGET_BD_ADDR]\n"); validParaLen = 6; if(setParaLen == validParaLen) { btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; if( (pBtReq->pParamStart[1]==0) && (pBtReq->pParamStart[2]==0) && (pBtReq->pParamStart[3]==0) && (pBtReq->pParamStart[4]==0) && (pBtReq->pParamStart[5]==0) && (pBtReq->pParamStart[6]==0) ) { DBG_8192C("[MPT], Error!! targetBDAddr=all zero\n"); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } if( (pBtReq->pParamStart[1]==0xff) && (pBtReq->pParamStart[2]==0xff) && (pBtReq->pParamStart[3]==0xff) && (pBtReq->pParamStart[4]==0xff) && (pBtReq->pParamStart[5]==0xff) && (pBtReq->pParamStart[6]==0xff) ) { DBG_8192C("[MPT], Error!! targetBDAddr=all 0xf\n"); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } bdAddr[0] = pBtReq->pParamStart[6]; bdAddr[1] = pBtReq->pParamStart[5]; bdAddr[2] = pBtReq->pParamStart[4]; bdAddr[3] = pBtReq->pParamStart[3]; bdAddr[4] = pBtReq->pParamStart[2]; bdAddr[5] = pBtReq->pParamStart[1]; DBG_8192C ("[MPT], target BDAddr:%x,%x,%x,%x,%x,%x\n", bdAddr[0],bdAddr[1],bdAddr[2],bdAddr[3],bdAddr[4],bdAddr[5]); } break; case BT_GSET_TX_PWR_FINETUNE: DBG_8192C("[MPT], [BT_GSET_TX_PWR_FINETUNE]\n"); validParaLen = 1; if(setParaLen == validParaLen) { btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; calVal = pBtReq->pParamStart[1]; if( (calVal<1) || (calVal>9) ) { pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } DBG_8192C ("[MPT], calVal=%d\n", calVal); } break; case BT_SET_TRACKING_INTERVAL: DBG_871X("[MPT], [BT_SET_TRACKING_INTERVAL] setParaLen =%d \n",setParaLen); validParaLen = 1; if(setParaLen == validParaLen) calVal = pBtReq->pParamStart[1]; break; case BT_SET_THERMAL_METER: DBG_871X("[MPT], [BT_SET_THERMAL_METER] setParaLen =%d \n",setParaLen); validParaLen = 1; if(setParaLen == validParaLen) calVal = pBtReq->pParamStart[1]; break; case BT_ENABLE_CFO_TRACKING: DBG_871X("[MPT], [BT_ENABLE_CFO_TRACKING] setParaLen =%d \n",setParaLen); validParaLen = 1; if(setParaLen == validParaLen) calVal = pBtReq->pParamStart[1]; break; case BT_GSET_UPDATE_BT_PATCH: break; default: { DBG_8192C ("[MPT], Error!! setType=%d, out of range\n", setType); pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } break; } if(setParaLen != validParaLen) { DBG_8192C("[MPT], Error!! wrong parameter length=%d for BT_SET_GEN_CMD cmd id=0x%x, paraLen should=0x%x\n", setParaLen, setType, validParaLen); pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; return paraLen; } // // execute lower layer opcodes // if(BT_GSET_REG == setType) { // fill h2c parameters // here we should write reg value first then write the address, adviced by Austin btOpcode = BT_LO_OP_WRITE_REG_VALUE; h2cParaBuf[0] = pBtReq->pParamStart[6]; h2cParaBuf[1] = pBtReq->pParamStart[7]; h2cParaBuf[2] = pBtReq->pParamStart[8]; h2cParaLen = 3; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } // write reg address btOpcode = BT_LO_OP_WRITE_REG_ADDR; h2cParaBuf[0] = regType; h2cParaBuf[1] = pBtReq->pParamStart[2]; h2cParaBuf[2] = pBtReq->pParamStart[3]; h2cParaLen = 3; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } } else if(BT_GSET_RESET == setType) { btOpcode = BT_LO_OP_RESET; h2cParaLen = 0; // execute h2c and check respond c2h from bt fw is correct or not retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } } else if(BT_GSET_TARGET_BD_ADDR == setType) { // fill h2c parameters btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_L; h2cParaBuf[0] = pBtReq->pParamStart[1]; h2cParaBuf[1] = pBtReq->pParamStart[2]; h2cParaBuf[2] = pBtReq->pParamStart[3]; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } btOpcode = BT_LO_OP_SET_TARGET_BD_ADDR_H; h2cParaBuf[0] = pBtReq->pParamStart[4]; h2cParaBuf[1] = pBtReq->pParamStart[5]; h2cParaBuf[2] = pBtReq->pParamStart[6]; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } } else if(BT_GSET_TX_PWR_FINETUNE == setType) { // fill h2c parameters btOpcode = BT_LO_OP_SET_TX_POWER_CALIBRATION; h2cParaBuf[0] = calVal; h2cParaLen = 1; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } } else if(BT_SET_TRACKING_INTERVAL == setType) { // BT_LO_OP_SET_TRACKING_INTERVAL = 0x22, // BT_LO_OP_SET_THERMAL_METER = 0x23, // BT_LO_OP_ENABLE_CFO_TRACKING = 0x24, btOpcode = BT_LO_OP_SET_TRACKING_INTERVAL; h2cParaBuf[0] = calVal; h2cParaLen = 1; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } } else if(BT_SET_THERMAL_METER == setType) { btOpcode = BT_LO_OP_SET_THERMAL_METER; h2cParaBuf[0] = calVal; h2cParaLen = 1; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } } else if(BT_ENABLE_CFO_TRACKING == setType) { btOpcode = BT_LO_OP_ENABLE_CFO_TRACKING; h2cParaBuf[0] = calVal; h2cParaLen = 1; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } } pBtRsp->status = BT_STATUS_SUCCESS; return paraLen; } u2Byte mptbt_BtSetTxRxPars( IN PADAPTER Adapter, IN PBT_REQ_CMD pBtReq, IN PBT_RSP_CMD pBtRsp ) { u1Byte h2cParaBuf[6] ={0}; u1Byte h2cParaLen=0; u2Byte paraLen=0; u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode; u1Byte btOpcodeVer=0; PBT_TXRX_PARAMETERS pTxRxPars=(PBT_TXRX_PARAMETERS)&pBtReq->pParamStart[0]; u2Byte lenTxRx=sizeof(BT_TXRX_PARAMETERS); u1Byte i; u1Byte bdAddr[6]={0}; // // check upper layer parameters // // 1. check upper layer opcode version if(pBtReq->opCodeVer != 1) { DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; return paraLen; } // 2. check upper layer parameter length if(pBtReq->paraLength == sizeof(BT_TXRX_PARAMETERS)) { DBG_8192C ("[MPT], pTxRxPars->txrxChannel=0x%x \n", pTxRxPars->txrxChannel); DBG_8192C ("[MPT], pTxRxPars->txrxTxPktCnt=0x%8x \n", pTxRxPars->txrxTxPktCnt); DBG_8192C ("[MPT], pTxRxPars->txrxTxPktInterval=0x%x \n", pTxRxPars->txrxTxPktInterval); DBG_8192C ("[MPT], pTxRxPars->txrxPayloadType=0x%x \n", pTxRxPars->txrxPayloadType); DBG_8192C ("[MPT], pTxRxPars->txrxPktType=0x%x \n", pTxRxPars->txrxPktType); DBG_8192C ("[MPT], pTxRxPars->txrxPayloadLen=0x%x \n", pTxRxPars->txrxPayloadLen); DBG_8192C ("[MPT], pTxRxPars->txrxPktHeader=0x%x \n", pTxRxPars->txrxPktHeader); DBG_8192C ("[MPT], pTxRxPars->txrxWhitenCoeff=0x%x \n", pTxRxPars->txrxWhitenCoeff); bdAddr[0] = pTxRxPars->txrxBdaddr[5]; bdAddr[1] = pTxRxPars->txrxBdaddr[4]; bdAddr[2] = pTxRxPars->txrxBdaddr[3]; bdAddr[3] = pTxRxPars->txrxBdaddr[2]; bdAddr[4] = pTxRxPars->txrxBdaddr[1]; bdAddr[5] = pTxRxPars->txrxBdaddr[0]; DBG_8192C ("[MPT], pTxRxPars->txrxBdaddr: %s", &bdAddr[0]); DBG_8192C ("[MPT], pTxRxPars->txrxTxGainIndex=0x%x \n", pTxRxPars->txrxTxGainIndex); } else { DBG_8192C ("[MPT], Error!! pBtReq->paraLength=%d, correct Len=%d\n", pBtReq->paraLength, lenTxRx); pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; return paraLen; } // // execute lower layer opcodes // // fill h2c parameters btOpcode = BT_LO_OP_SET_PKT_HEADER; if(pTxRxPars->txrxPktHeader > 0x3ffff) { DBG_8192C ("[MPT], Error!! pTxRxPars->txrxPktHeader=0x%x is out of range, (should be between 0x0~0x3ffff)\n", pTxRxPars->txrxPktHeader); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { h2cParaBuf[0] = (u1Byte)(pTxRxPars->txrxPktHeader&0xff); h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPktHeader&0xff00)>>8); h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPktHeader&0xff0000)>>16); h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } // fill h2c parameters btOpcode = BT_LO_OP_SET_PKT_TYPE_LEN; { u2Byte payloadLenLimit=0; switch(pTxRxPars->txrxPktType) { case MP_BT_PKT_DH1: payloadLenLimit = 27*8; break; case MP_BT_PKT_DH3: payloadLenLimit = 183*8; break; case MP_BT_PKT_DH5: payloadLenLimit = 339*8; break; case MP_BT_PKT_2DH1: payloadLenLimit = 54*8; break; case MP_BT_PKT_2DH3: payloadLenLimit = 367*8; break; case MP_BT_PKT_2DH5: payloadLenLimit = 679*8; break; case MP_BT_PKT_3DH1: payloadLenLimit = 83*8; break; case MP_BT_PKT_3DH3: payloadLenLimit = 552*8; break; case MP_BT_PKT_3DH5: payloadLenLimit = 1021*8; break; case MP_BT_PKT_LE: payloadLenLimit = 39*8; break; default: { DBG_8192C ("[MPT], Error!! Unknown pTxRxPars->txrxPktType=0x%x\n", pTxRxPars->txrxPktType); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } break; } if(pTxRxPars->txrxPayloadLen > payloadLenLimit) { DBG_8192C ("[MPT], Error!! pTxRxPars->txrxPayloadLen=0x%x, (should smaller than %d)\n", pTxRxPars->txrxPayloadLen, payloadLenLimit); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } h2cParaBuf[0] = pTxRxPars->txrxPktType; h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPayloadLen&0xff)); h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPayloadLen&0xff00)>>8); h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } // fill h2c parameters btOpcode = BT_LO_OP_SET_PKT_CNT_L_PL_TYPE; if(pTxRxPars->txrxPayloadType > MP_BT_PAYLOAD_MAX) { DBG_8192C ("[MPT], Error!! pTxRxPars->txrxPayloadType=0x%x, (should be between 0~4)\n", pTxRxPars->txrxPayloadType); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff)); h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff00)>>8); h2cParaBuf[2] = pTxRxPars->txrxPayloadType; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } // fill h2c parameters btOpcode = BT_LO_OP_SET_PKT_CNT_H_PKT_INTV; if(pTxRxPars->txrxTxPktInterval > 15) { DBG_8192C ("[MPT], Error!! pTxRxPars->txrxTxPktInterval=0x%x, (should be between 0~15)\n", pTxRxPars->txrxTxPktInterval); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff0000)>>16); h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt&0xff000000)>>24); h2cParaBuf[2] = pTxRxPars->txrxTxPktInterval; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } // fill h2c parameters btOpcode = BT_LO_OP_SET_WHITENCOEFF; { h2cParaBuf[0] = pTxRxPars->txrxWhitenCoeff; h2cParaLen = 1; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } // fill h2c parameters btOpcode = BT_LO_OP_SET_CHNL_TX_GAIN; if( (pTxRxPars->txrxChannel > 78) || (pTxRxPars->txrxTxGainIndex > 7) ) { DBG_8192C ("[MPT], Error!! pTxRxPars->txrxChannel=0x%x, (should be between 0~78)\n", pTxRxPars->txrxChannel); DBG_8192C ("[MPT], Error!! pTxRxPars->txrxTxGainIndex=0x%x, (should be between 0~7)\n", pTxRxPars->txrxTxGainIndex); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { h2cParaBuf[0] = pTxRxPars->txrxChannel; h2cParaBuf[1] = pTxRxPars->txrxTxGainIndex; h2cParaLen = 2; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } // fill h2c parameters btOpcode = BT_LO_OP_SET_BD_ADDR_L; if( (pTxRxPars->txrxBdaddr[0]==0) && (pTxRxPars->txrxBdaddr[1]==0) && (pTxRxPars->txrxBdaddr[2]==0) && (pTxRxPars->txrxBdaddr[3]==0) && (pTxRxPars->txrxBdaddr[4]==0) && (pTxRxPars->txrxBdaddr[5]==0) ) { DBG_8192C ("[MPT], Error!! pTxRxPars->txrxBdaddr=all zero\n"); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } if( (pTxRxPars->txrxBdaddr[0]==0xff) && (pTxRxPars->txrxBdaddr[1]==0xff) && (pTxRxPars->txrxBdaddr[2]==0xff) && (pTxRxPars->txrxBdaddr[3]==0xff) && (pTxRxPars->txrxBdaddr[4]==0xff) && (pTxRxPars->txrxBdaddr[5]==0xff) ) { DBG_8192C ("[MPT], Error!! pTxRxPars->txrxBdaddr=all 0xf\n"); pBtRsp->status = (btOpcode<<8)|BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } { h2cParaBuf[0] = pTxRxPars->txrxBdaddr[0]; h2cParaBuf[1] = pTxRxPars->txrxBdaddr[1]; h2cParaBuf[2] = pTxRxPars->txrxBdaddr[2]; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } btOpcode = BT_LO_OP_SET_BD_ADDR_H; { h2cParaBuf[0] = pTxRxPars->txrxBdaddr[3]; h2cParaBuf[1] = pTxRxPars->txrxBdaddr[4]; h2cParaBuf[2] = pTxRxPars->txrxBdaddr[5]; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // ckeck bt return status. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C ("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->status = BT_STATUS_SUCCESS; return paraLen; } u2Byte mptbt_BtTestCtrl( IN PADAPTER Adapter, IN PBT_REQ_CMD pBtReq, IN PBT_RSP_CMD pBtRsp ) { u1Byte h2cParaBuf[6] ={0}; u1Byte h2cParaLen=0; u2Byte paraLen=0; u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode; u1Byte btOpcodeVer=0; u1Byte testCtrl=0; // // check upper layer parameters // // 1. check upper layer opcode version if(pBtReq->opCodeVer != 1) { DBG_8192C("[MPT], Error!! Upper OP code version not match!!!\n"); pBtRsp->status = BT_STATUS_OPCODE_U_VERSION_MISMATCH; return paraLen; } // 2. check upper layer parameter length if(1 == pBtReq->paraLength) { testCtrl = pBtReq->pParamStart[0]; DBG_8192C("[MPT], testCtrl=%d \n", testCtrl); } else { DBG_8192C("[MPT], Error!! wrong parameter length=%d (should be 1)\n", pBtReq->paraLength); pBtRsp->status = BT_STATUS_PARAMETER_FORMAT_ERROR_U; return paraLen; } // // execute lower layer opcodes // // 1. fill h2c parameters // check bt mode btOpcode = BT_LO_OP_TEST_CTRL; if(testCtrl >= MP_BT_TEST_MAX) { DBG_8192C("[MPT], Error!! testCtrl=0x%x, (should be between smaller or equal to 0x%x)\n", testCtrl, MP_BT_TEST_MAX-1); pBtRsp->status = BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { h2cParaBuf[0] = testCtrl; h2cParaLen = 1; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } // 3. construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->status = BT_STATUS_SUCCESS; return paraLen; } u2Byte mptbt_TestBT( IN PADAPTER Adapter, IN PBT_REQ_CMD pBtReq, IN PBT_RSP_CMD pBtRsp ) { u1Byte h2cParaBuf[6] ={0}; u1Byte h2cParaLen=0; u2Byte paraLen=0; u1Byte retStatus=BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode; u1Byte btOpcodeVer=0; u1Byte testCtrl=0; // 1. fill h2c parameters btOpcode = 0x11; h2cParaBuf[0] = 0x11; h2cParaBuf[1] = 0x0; h2cParaBuf[2] = 0x0; h2cParaBuf[3] = 0x0; h2cParaBuf[4] = 0x0; h2cParaLen = 1; // retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, h2cParaBuf, h2cParaLen); // 3. construct respond status code and data. if(BT_STATUS_BT_OP_SUCCESS != retStatus) { pBtRsp->status = ((btOpcode<<8)|retStatus); DBG_8192C("[MPT], Error!! status code=0x%x \n", pBtRsp->status); return paraLen; } pBtRsp->status = BT_STATUS_SUCCESS; return paraLen; } VOID mptbt_BtControlProcess( PADAPTER Adapter, PVOID pInBuf ) { u1Byte H2C_Parameter[6] ={0}; PBT_H2C pH2c=(PBT_H2C)&H2C_Parameter[0]; PMPT_CONTEXT pMptCtx=&(Adapter->mppriv.MptCtx); PBT_REQ_CMD pBtReq=(PBT_REQ_CMD)pInBuf; PBT_RSP_CMD pBtRsp; u1Byte i; DBG_8192C("[MPT], mptbt_BtControlProcess()=========>\n"); DBG_8192C("[MPT], input opCodeVer=%d\n", pBtReq->opCodeVer); DBG_8192C("[MPT], input OpCode=%d\n", pBtReq->OpCode); DBG_8192C("[MPT], paraLength=%d \n", pBtReq->paraLength); if(pBtReq->paraLength) { //DBG_8192C("[MPT], parameters(hex):0x%x %d \n",&pBtReq->pParamStart[0], pBtReq->paraLength); } _rtw_memset((void*)pMptCtx->mptOutBuf, 0, 100); pMptCtx->mptOutLen = 4; //length of (BT_RSP_CMD.status+BT_RSP_CMD.paraLength) pBtRsp = (PBT_RSP_CMD)pMptCtx->mptOutBuf; pBtRsp->status = BT_STATUS_SUCCESS; pBtRsp->paraLength = 0x0; // The following we should maintain the User OP codes sent by upper layer switch(pBtReq->OpCode) { case BT_UP_OP_BT_READY: DBG_8192C("[MPT], OPcode : [BT_READY]\n"); pBtRsp->paraLength = mptbt_BtReady(Adapter, pBtReq, pBtRsp); break; case BT_UP_OP_BT_SET_MODE: DBG_8192C("[MPT], OPcode : [BT_SET_MODE]\n"); pBtRsp->paraLength = mptbt_BtSetMode(Adapter, pBtReq, pBtRsp); break; case BT_UP_OP_BT_SET_TX_RX_PARAMETER: DBG_8192C("[MPT], OPcode : [BT_SET_TXRX_PARAMETER]\n"); pBtRsp->paraLength = mptbt_BtSetTxRxPars(Adapter, pBtReq, pBtRsp); break; case BT_UP_OP_BT_SET_GENERAL: DBG_8192C("[MPT], OPcode : [BT_SET_GENERAL]\n"); pBtRsp->paraLength = mptbt_BtSetGeneral(Adapter, pBtReq, pBtRsp); break; case BT_UP_OP_BT_GET_GENERAL: DBG_8192C("[MPT], OPcode : [BT_GET_GENERAL]\n"); pBtRsp->paraLength = mptbt_BtGetGeneral(Adapter, pBtReq, pBtRsp); break; case BT_UP_OP_BT_TEST_CTRL: DBG_8192C("[MPT], OPcode : [BT_TEST_CTRL]\n"); pBtRsp->paraLength = mptbt_BtTestCtrl(Adapter, pBtReq, pBtRsp); break; case BT_UP_OP_TEST_BT: DBG_8192C("[MPT], OPcode : [TEST_BT]\n"); pBtRsp->paraLength = mptbt_TestBT(Adapter, pBtReq, pBtRsp); break; default: DBG_8192C("[MPT], Error!! OPcode : UNDEFINED!!!!\n"); pBtRsp->status = BT_STATUS_UNKNOWN_OPCODE_U; pBtRsp->paraLength = 0x0; break; } pMptCtx->mptOutLen += pBtRsp->paraLength; DBG_8192C("[MPT], pMptCtx->mptOutLen=%d, pBtRsp->paraLength=%d\n", pMptCtx->mptOutLen, pBtRsp->paraLength); DBG_8192C("[MPT], mptbt_BtControlProcess()<=========\n"); } #endif