| /* |
| * fwdriverdebug.c |
| * |
| * Copyright(c) 1998 - 2009 Texas Instruments. All rights reserved. |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in |
| * the documentation and/or other materials provided with the |
| * distribution. |
| * * Neither the name Texas Instruments nor the names of its |
| * contributors may be used to endorse or promote products derived |
| * from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR |
| * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT |
| * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
| * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
| * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
| * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| |
| /***************************************************************************/ |
| /* */ |
| /* MODULE: FW_debug.c */ |
| /* PURPOSE: FW debug implementation */ |
| /* */ |
| /***************************************************************************/ |
| #include "tidef.h" |
| #include "DrvMain.h" |
| #include "CmdQueue_api.h" |
| #include "debug.h" |
| #include "connDebug.h" |
| #include "siteMgrDebug.h" |
| #include "dataCtrlDbg.h" |
| #include "rsnDbg.h" |
| #include "osApi.h" |
| #include "report.h" |
| #include "qosMngrDbg.h" |
| #include "PowerMgrDebug.h" |
| #include "roamingMgrDebug.h" |
| #include "scanCncnDbg.h" |
| #include "ScanMngrDbg.h" |
| #include "scrDbg.h" |
| #include "SoftGeminiDbg.h" |
| #include "HealthMonitorDbg.h" |
| #include "smeDebug.h" |
| #include "TWDriver.h" |
| #include "CmdBld.h" |
| #include "commonTypes.h" |
| #include "siteHash.h" |
| #include "txCtrl.h" |
| #include "802_11Defs.h" |
| #include "fwdriverdebug.h" |
| #include "mlmeBuilder.h" |
| #include "Ethernet.h" |
| |
| static TI_HANDLE dTimer; |
| static TI_HANDLE tmp_hMlme; |
| static TI_HANDLE tmp_hTWD; |
| static TI_HANDLE tmp_hTxCtrl; |
| static TI_BOOL SendFlag = 0; |
| static TI_BOOL bSendDataPkt; |
| static volatile TI_UINT32 numOfPackets; |
| static volatile TI_UINT8 infinitLoopFl = 0; |
| static TI_UINT32 packetsNum; |
| static TI_UINT32 packetLength; |
| |
| typedef TI_STATUS (*TCmdCfgFuncB) (TI_HANDLE); |
| |
| extern TI_STATUS cmdBld_CmdJoinBss (TI_HANDLE hCmdBld, TJoinBss *pJoinBssParams, void *fCb, TI_HANDLE hCb); |
| void sendMgmtPacket (TI_HANDLE hOs); |
| void sendDataPacket (TI_HANDLE hOs); |
| |
| void FWDebugFunction(TI_HANDLE hDrvMain, |
| TI_HANDLE hOs, |
| TI_HANDLE hTWD, |
| TI_HANDLE hMlme, |
| TI_HANDLE hTxMgmtQ, |
| TI_HANDLE hTxCtrl, |
| unsigned long funcType, |
| void *pParam) |
| { |
| tmp_hMlme = hMlme; |
| tmp_hTWD = hTWD; |
| tmp_hTxCtrl = hTxCtrl; |
| |
| switch (funcType) |
| { |
| case DBG_FW_PRINT_HELP: |
| printFWDbgFunctions(); |
| break; |
| case DBG_FW_SEND_GENERAL_TEST_CMD: |
| FW_debugSendGeneralTestCmd(hTWD, pParam); |
| break; |
| case DBG_FW_IBSS_CONNECTION: |
| FW_DebugSendJoinCommand(hTWD, hTxMgmtQ); |
| break; |
| case DBG_FW_SEND_MGMT_PACKET: |
| bSendDataPkt = TI_FALSE; |
| FW_DebugSendPacket(hDrvMain, hOs, hTxMgmtQ, pParam); |
| break; |
| case DBG_FW_SEND_DATA_PACKET: |
| bSendDataPkt = TI_TRUE; |
| FW_DebugSendPacket(hDrvMain, hOs, hTxMgmtQ, pParam); |
| break; |
| case DBG_FW_START_LOOPBACK: |
| FW_DebugStartLoopBack (hDrvMain, hTWD); |
| break; |
| case DBG_FW_STOP_LOOPBACK: |
| FW_DebugStopLoopBack (hDrvMain, hTWD); |
| break; |
| case DBG_FW_INFINIT_SEND: |
| FW_DebugInfinitSendPacket (hDrvMain, hTWD); |
| break; |
| |
| case DBG_FW_GENERAL: |
| FW_DebugGeneral (hTWD, pParam); |
| break; |
| default: |
| break; |
| |
| |
| } |
| } |
| |
| void printFWDbgFunctions(void) |
| { |
| WLAN_OS_REPORT((" FW Debug Functions \n")); |
| WLAN_OS_REPORT(("---------------------------------------------------\n")); |
| WLAN_OS_REPORT(("2200 - Print the FW Debug Help \n")); |
| WLAN_OS_REPORT(("2201 - Send General Test Command \n")); |
| WLAN_OS_REPORT(("2202 - create IBSS connection \n")); |
| WLAN_OS_REPORT(("2203[n] - Send n<=999 Packets \n")); |
| WLAN_OS_REPORT(("2205 - Start LoopBack \n")); |
| WLAN_OS_REPORT(("2206 - Stop LoopBack \n")); |
| } |
| |
| |
| void FW_debugSendGeneralTestCmd(TI_HANDLE hTWD, void *pParam) |
| { |
| TTwd *pTWD = (TTwd *)hTWD; |
| FWDebugTestCmdParamter_t Cfg; |
| unsigned char Len; |
| Len = *(unsigned char *)pParam; |
| |
| os_memoryCopy(pTWD->hOs, Cfg.buf,(unsigned long*)pParam + sizeof(TI_UINT8),Len * 4 ); |
| |
| Cfg.len = Len; |
| |
| /* Set information element header */ |
| Cfg.EleHdr.id = CMD_TEST; |
| Cfg.EleHdr.len = sizeof(Cfg) - sizeof(EleHdrStruct); |
| |
| cmdQueue_SendCommand (pTWD->hCmdQueue, CMD_CONFIGURE, (void*)&Cfg, sizeof(Cfg), NULL, NULL, NULL); |
| } |
| |
| void FW_DebugSendJoinCommand(TI_HANDLE hTWD, TI_HANDLE hTxMgmtQ) |
| { |
| TTwd *pTWD = (TTwd *)hTWD; |
| TCmdBld *pCmdBld = (TCmdBld *)(pTWD->hCmdBld); |
| TI_STATUS res; |
| TJoinBss JoinBss; |
| char ssid[10]; |
| unsigned char Bssid[6] = {0x0,0x12,0x43,0xad,0xe5,0x10}; |
| |
| os_memoryCopy(pTWD->hOs,ssid,"ronit",5); |
| |
| JoinBss.basicRateSet = DRV_RATE_2M; |
| JoinBss.radioBand = RADIO_BAND_2_4_GHZ; |
| JoinBss.pBSSID = Bssid; |
| |
| JoinBss.bssType = BSS_INDEPENDENT; |
| JoinBss.pSSID =ssid; |
| JoinBss.ssidLength = 5; |
| JoinBss.channel = 1; |
| JoinBss.beaconInterval = 100; |
| JoinBss.dtimInterval = 2; |
| |
| pCmdBld->hReport = pTWD->hReport; |
| pCmdBld->tDb.bss.BssId[0] = 0x0; |
| pCmdBld->tDb.bss.BssId[1] = 0x12; |
| pCmdBld->tDb.bss.BssId[2] = 0x43; |
| pCmdBld->tDb.bss.BssId[3] = 0xad; |
| pCmdBld->tDb.bss.BssId[4] = 0xe5; |
| pCmdBld->tDb.bss.BssId[5] = 0x10; |
| pCmdBld->tDb.bss.RadioChannel = 1; |
| |
| txMgmtQ_SetConnState(hTxMgmtQ,TX_CONN_STATE_MGMT); |
| |
| res = cmdBld_CmdJoinBss (pCmdBld, |
| &JoinBss, |
| NULL,//cmdBld_ConfigSeq, |
| NULL);//pTWD->hCmdBld |
| |
| if (res) |
| { |
| os_printf("\n failed to make IBSS connection\n"); |
| } |
| |
| os_printf("\n res = %d\n", res); |
| |
| txMgmtQ_SetConnState(hTxMgmtQ, TX_CONN_STATE_MGMT); |
| |
| } |
| |
| |
| void sendDataPacket (TI_HANDLE hOs) |
| { |
| TI_UINT32 i; |
| TTxCtrlBlk * pPktCtrlBlk; |
| TI_UINT8 * pPktBuf; |
| TEthernetHeader tEthHeader; |
| char SrcBssid[6] = {0x88,0x88,0x88,0x88,0x88,0x88}; |
| char DesBssid[6] = {0x22,0x22,0x22,0x22,0x22,0x22}; |
| |
| /* Allocate a TxCtrlBlk for the Tx packet and save timestamp, length and packet handle */ |
| pPktCtrlBlk = TWD_txCtrlBlk_Alloc (tmp_hTWD); |
| pPktCtrlBlk->tTxDescriptor.startTime = os_timeStampMs (hOs); |
| pPktCtrlBlk->tTxDescriptor.length = (TI_UINT16)packetLength + ETHERNET_HDR_LEN; |
| pPktCtrlBlk->tTxDescriptor.tid = 0; |
| pPktCtrlBlk->tTxPktParams.uPktType = TX_PKT_TYPE_ETHER; |
| |
| /* Allocate buffer with headroom for getting the IP header in a 4-byte aligned address */ |
| pPktBuf = txCtrl_AllocPacketBuffer (tmp_hTxCtrl, pPktCtrlBlk, packetLength + ETHERNET_HDR_LEN + 2); |
| |
| /* Prepare Ethernet header */ |
| tEthHeader.type = HTOWLANS(ETHERTYPE_IP); |
| MAC_COPY (tEthHeader.src, SrcBssid); |
| MAC_COPY (tEthHeader.dst, DesBssid); |
| os_memoryCopy (hOs, pPktBuf + 2, &tEthHeader, ETHERNET_HDR_LEN); |
| |
| /* Build BDL */ |
| BUILD_TX_TWO_BUF_PKT_BDL (pPktCtrlBlk, |
| pPktBuf + 2, |
| ETHERNET_HDR_LEN, |
| pPktBuf + 2 + ETHERNET_HDR_LEN, |
| packetLength) |
| |
| /* Fill data buffer with incremented numbers */ |
| for (i = 0; i < packetLength; i++) |
| { |
| *(pPktBuf + 2 + ETHERNET_HDR_LEN + i) = i; |
| } |
| |
| /* Send Ether packet to TxCtrl */ |
| txCtrl_XmitData (tmp_hTxCtrl, pPktCtrlBlk); |
| } |
| |
| |
| |
| void sendMgmtPacket(TI_HANDLE hOs) |
| { |
| static TI_UINT8 aMsg[2000]; |
| TI_UINT32 i; |
| dot11MgmtSubType_e eMsgType = DE_AUTH; |
| |
| for (i = 0; i < packetLength; i++) |
| { |
| aMsg[i] = i; |
| } |
| |
| mlmeBuilder_sendFrame(tmp_hMlme, eMsgType, aMsg, packetLength, 0); |
| |
| numOfPackets++; |
| if ((infinitLoopFl == 0) && (numOfPackets > packetsNum)) |
| { |
| os_timerStop(hOs, dTimer); |
| os_printf("\n *********** Last Packet was sent **********"); |
| os_timerDestroy(hOs, dTimer); |
| } |
| else |
| { |
| os_timerStart(hOs, dTimer, 1000); |
| } |
| } |
| |
| void FW_DebugSendPacket(TI_HANDLE hDrvMain ,TI_HANDLE hOs, TI_HANDLE hTxMgmtQ, void *pParam) |
| { |
| void *fSendPkt; |
| |
| if ( pParam == NULL ) |
| { |
| os_printf("\nFW_DebugSendPacket Error: received NULL parameter\n"); |
| return; |
| } |
| |
| /* Open Tx path for all packet types */ |
| txMgmtQ_SetConnState (hTxMgmtQ, TX_CONN_STATE_MGMT); |
| txMgmtQ_SetConnState (hTxMgmtQ, TX_CONN_STATE_EAPOL); |
| txMgmtQ_SetConnState (hTxMgmtQ, TX_CONN_STATE_OPEN); |
| |
| infinitLoopFl = 0; |
| numOfPackets = 1; |
| packetsNum = 1; |
| packetLength = *(TI_UINT32*)pParam; |
| os_printf("\nFW_DebugSendPacket: packetsNum = %d, packetLength = %d\n",packetsNum, packetLength); |
| fSendPkt = bSendDataPkt ? sendDataPacket : sendMgmtPacket; |
| dTimer = os_timerCreate(hOs, fSendPkt, hDrvMain); |
| os_timerStart(hOs, dTimer, 1000); |
| |
| SendFlag = TI_TRUE; |
| } |
| |
| void FW_DebugInfinitSendPacket(TI_HANDLE hDrvMain ,TI_HANDLE hOs) |
| { |
| infinitLoopFl = 1; |
| numOfPackets = 1; |
| |
| dTimer = os_timerCreate(hOs, sendMgmtPacket, hDrvMain); |
| os_timerStart(hOs, dTimer, 1000); |
| SendFlag = TI_TRUE; |
| } |
| |
| void FW_DebugStartLoopBack (TI_HANDLE hDrvMain, TI_HANDLE hTWD) |
| { |
| TTwd *pTWD = (TTwd *)hTWD; |
| TTestCmd Plt; |
| |
| Plt.testCmdId = TEST_CMD_LOOPBACK_START; |
| os_printf("\n send loopback start command"); |
| cmdQueue_SendCommand (pTWD->hCmdQueue, CMD_TEST, (char*)&Plt, sizeof(Plt), NULL, NULL, NULL); |
| } |
| |
| |
| void FW_DebugStopLoopBack (TI_HANDLE hDrvMain, TI_HANDLE hTWD) |
| { |
| TTwd *pTWD = (TTwd *)hTWD; |
| TTestCmd Plt; |
| |
| Plt.testCmdId = TEST_CMD_LOOPBACK_STOP; |
| os_printf("\n send loopback stop command"); |
| cmdQueue_SendCommand (pTWD->hCmdQueue, CMD_TEST, (char*)&Plt, sizeof(Plt), NULL, NULL, NULL); |
| } |
| |
| |
| void FW_DebugGeneral(TI_HANDLE hTWD, void *pParam) |
| { |
| TTwd *pTWD = (TTwd *)hTWD; |
| TI_UINT32 size = *((TI_UINT32*) pParam) + sizeof(TI_UINT32); |
| |
| cmdQueue_SendCommand (pTWD->hCmdQueue, CMD_DEBUG, (char*)pParam, size, NULL, NULL, NULL); |
| } |
| |
| |
| /* |
| void FW_ComparePacket (char *buf) |
| { |
| char *ptemp; |
| int i; |
| |
| if (SendFlag) |
| { |
| ptemp = CompBuf; |
| os_printf("\n print before compare save buf"); |
| os_printf("\n"); |
| for (i=0;i<Len;i++) { |
| os_printf(" 0x%02x ",*ptemp++); |
| if (i %5 == 0) { os_printf("\n"); |
| } |
| |
| } |
| |
| os_printf("\n print before compare recived packet"); |
| ptemp = buf; |
| os_printf("\n"); |
| for (i=0;i<Len;i++) { |
| os_printf(" 0x%02x ",*ptemp++); |
| if (i %5 == 0) { |
| } |
| |
| } |
| |
| |
| if(memcmp(CompBuf,buf,Len)) |
| os_printf("\n LoopBack Packet failed"); |
| else |
| os_printf("\n LoopBack Packet success"); |
| |
| SendFlag = TI_FALSE; |
| } |
| |
| } |
| */ |
| |
| |
