projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
import PULS_20160108
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / misc / mediatek / connectivity / conn_soc / drv_wlan / mt_wifi / wlan / mgmt / swcr.c
CommitLineData
6fa3eb70
S		 1/*
2** $Id: //Department/DaVinci/BRANCHES/MT6620_WIFI_DRIVER_V2_3/mgmt/swcr.c#1 $
3*/
4
5/*! \file "swcr.c"
6 \brief
7
8*/
9
10
11
12/*
13** $Log: swcr.c $
14 *
15 * 06 04 2012 tsaiyuan.hsu
16 * [WCXRP00001249] [ALPS.ICS] Daily build warning on "wlan/mgmt/swcr.c#1"
17 * resolve build waring for "WNM_UNIT_TEST not defined".
18 *
19 * 03 02 2012 terry.wu
20 * NULL
21 * Sync CFG80211 modification from branch 2,2.
22 *
23 * 01 05 2012 tsaiyuan.hsu
24 * [WCXRP00001157] [MT6620 Wi-Fi][FW][DRV] add timing measurement support for 802.11v
25 * add timing measurement support for 802.11v.
26 *
27 * 11 22 2011 tsaiyuan.hsu
28 * [WCXRP00001083] [MT6620 Wi-Fi][DRV]] dump debug counter or frames when debugging is triggered
29 * keep debug counter setting after wake up.
30 *
31 * 11 15 2011 cm.chang
32 * NULL
33 * Fix compiling warning
34 *
35 * 11 11 2011 tsaiyuan.hsu
36 * [WCXRP00001083] [MT6620 Wi-Fi][DRV]] dump debug counter or frames when debugging is triggered
37 * fix debug counters of rx in driver.
38 *
39 * 11 11 2011 tsaiyuan.hsu
40 * [WCXRP00001083] [MT6620 Wi-Fi][DRV]] dump debug counter or frames when debugging is triggered
41 * add debug counters of bb and ar for xlog.
42 *
43 * 11 10 2011 eddie.chen
44 * [WCXRP00001096] [MT6620 Wi-Fi][Driver/FW] Enhance the log function (xlog)
45 * Modify the QM xlog level and remove LOG_FUNC.
46 *
47 * 11 08 2011 tsaiyuan.hsu
48 * [WCXRP00001083] [MT6620 Wi-Fi][DRV]] dump debug counter or frames when debugging is triggered
49 * add debug counters, eCurPsProf, for PS.
50 *
51 * 11 07 2011 tsaiyuan.hsu
52 * [WCXRP00001083] [MT6620 Wi-Fi][DRV]] dump debug counter or frames when debugging is triggered
53 * add debug counters and periodically dump counters for debugging.
54 *
55 * 11 03 2011 wh.su
56 * [WCXRP00001078] [MT6620 Wi-Fi][Driver] Adding the mediatek log improment support : XLOG
57 * change the DBGLOG for "\n" and "\r\n". LABEL to LOUD for XLOG
58 *
59 * 08 31 2011 tsaiyuan.hsu
60 * [WCXRP00000931] [MT5931 Wi-Fi][DRV/FW] add swcr to disable roaming from driver
61 * remove obsolete code.
62 *
63 * 08 15 2011 tsaiyuan.hsu
64 * [WCXRP00000931] [MT5931 Wi-Fi][DRV/FW] add swcr to disable roaming from driver
65 * add swcr in driver reg, 0x9fxx0000, to disable roaming .
66 *
67 * 05 11 2011 eddie.chen
68 * [WCXRP00000709] [MT6620 Wi-Fi][Driver] Check free number before copying broadcast packet
69 * Fix dest type when GO packet copying.
70 *
71 * 05 09 2011 eddie.chen
72 * [WCXRP00000709] [MT6620 Wi-Fi][Driver] Check free number before copying broadcast packet
73 * Check free number before copying broadcast packet.
74 *
75 * 04 14 2011 eddie.chen
76 * [WCXRP00000603] [MT6620 Wi-Fi][DRV] Fix Klocwork warning
77 * Check the SW RFB free. Fix the compile warning..
78 *
79 * 04 12 2011 eddie.chen
80 * [WCXRP00000617] [MT6620 Wi-Fi][DRV/FW] Fix for sigma
81 * Fix the sta index in processing security frame
82 * Simple flow control for TC4 to avoid mgt frames for PS STA to occupy the TC4
83 * Add debug message.
84 *
85 * 03 28 2011 eddie.chen
86 * [WCXRP00000603] [MT6620 Wi-Fi][DRV] Fix Klocwork warning
87 * Fix Klockwork warning.
88 *
89 * 03 15 2011 eddie.chen
90 * [WCXRP00000554] [MT6620 Wi-Fi][DRV] Add sw control debug counter
91 * Add sw debug counter for QM.
92 *
93 * 01 11 2011 eddie.chen
94 * [WCXRP00000322] Add WMM IE in beacon,
95Add per station flow control when STA is in PS
96
97 * Add swcr for test.
98 *
99*
100*/
101
102
103/*******************************************************************************
104* C O M P I L E R F L A G S
105********************************************************************************
106*/
107
108/*******************************************************************************
109* E X T E R N A L R E F E R E N C E S
110********************************************************************************
111*/
112#include "precomp.h"
113
114#if CFG_SUPPORT_SWCR
115
116#ifdef __GNUC__
117#pragma GCC diagnostic ignored "-Wformat"
118#endif
119/*******************************************************************************
120* D A T A T Y P E S
121********************************************************************************
122*/
123
124/*******************************************************************************
125* P U B L I C D A T A
126********************************************************************************
127*/
128#if 0
129extern SWCR_MAP_ENTRY_T g_arRlmArSwCrMap[];
130SWCR_MOD_MAP_ENTRY_T g_arSwCrAllMaps[] = {
131 { SWCR_MAP_NUM(g_arRlmArSwCrMap), g_arRlmArSwCrMap}, /* 0x00nn */
132 {0,NULL}
133};
134#endif
135
136VOID swCtrlCmdCategory0(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1);
137VOID swCtrlCmdCategory1(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1);
138VOID testPsCmdCategory0(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1);
139VOID testPsCmdCategory1(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1);
140void testWNMCmdCategory0(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1);
141VOID swCtrlSwCr(P_ADAPTER_T prAdapter, UINT_8 ucRead, UINT_16 u2Addr, UINT_32 *pu4Data);
142
143/* Support Debug */
144VOID swCrDebugCheck(P_ADAPTER_T prAdapter, P_CMD_SW_DBG_CTRL_T prCmdSwCtrl);
145VOID swCrDebugCheckTimeout(
146 IN P_ADAPTER_T prAdapter,
147 ULONG ulParam);
148VOID swCrDebugQuery(
149 IN P_ADAPTER_T prAdapter,
150 IN P_CMD_INFO_T prCmdInfo,
151 IN PUINT_8 pucEventBuf
152 );
153VOID swCrDebugQueryTimeout(
154 IN P_ADAPTER_T prAdapter,
155 IN P_CMD_INFO_T prCmdInfo);
156
157UINT_32 g_au4SwCr[SWCR_CR_NUM]; /*: 0: command other: data */
158
159/* JB mDNS Filter*/
160UINT_32 g_u4mDNSRXFilter = 0; /* [31] 0: stop 1: start, [3] IPv6 [2] IPv4*/
161
162static TIMER_T g_rSwcrDebugTimer;
163static BOOLEAN g_fgSwcrDebugTimer = FALSE;
164static UINT_32 g_u4SwcrDebugCheckTimeout = 0;
165static ENUM_SWCR_DBG_TYPE_T g_ucSwcrDebugCheckType = 0;
166static UINT_32 g_u4SwcrDebugFrameDumpType = 0;
167
168/*******************************************************************************
169* P R I V A T E D A T A
170********************************************************************************
171*/
172#define TEST_PS 1
173
174const static PFN_CMD_RW_T g_arSwCtrlCmd[] ={
175 swCtrlCmdCategory0,
176 swCtrlCmdCategory1
177#if TEST_PS
178 , testPsCmdCategory0
179 , testPsCmdCategory1
180#endif
181#if CFG_SUPPORT_802_11V
182#if (CFG_SUPPORT_802_11V_TIMING_MEASUREMENT ==1) && (WNM_UNIT_TEST ==1)
183 , testWNMCmdCategory0
184#endif
185#endif
186};
187
188
189const PFN_SWCR_RW_T g_arSwCrModHandle[] = {
190 swCtrlSwCr,
191 NULL
192};
193
194
195/*******************************************************************************
196* M A C R O S
197********************************************************************************
198*/
199
200enum {
201 SWCTRL_MAGIC,
202 SWCTRL_DEBUG,
203 SWCTRL_WIFI_VAR,
204 SWCTRL_ENABLE_INT,
205 SWCTRL_DISABLE_INT,
206 SWCTRL_TXM_INFO,
207 SWCTRL_RXM_INFO,
208 SWCTRL_DUMP_BSS,
209 SWCTRL_QM_INFO,
210 SWCTRL_DUMP_ALL_QUEUE_LEN,
211 SWCTRL_DUMP_MEM,
212 SWCTRL_TX_CTRL_INFO,
213 SWCTRL_DUMP_QUEUE,
214 SWCTRL_DUMP_QM_DBG_CNT,
215 SWCTRL_QM_DBG_CNT,
216 SWCTRL_RX_PKTS_DUMP,
217 SWCTRL_RX_MDNS_FILTER,
218 SWCTRL_CATA0_INDEX_NUM
219};
220
221enum {
222 SWCTRL_STA_INFO,
223 SWCTRL_DUMP_STA,
224 SWCTRL_STA_QUE_INFO,
225 SWCTRL_CATA1_INDEX_NUM
226};
227
228/* JB mDNS Filter*/
229#define RX_MDNS_FILTER_START (1<<31)
230#define RX_MDNS_FILTER_IPV4 (1<<2)
231#define RX_MDNS_FILTER_IPV6 (1<<3)
232typedef enum _ENUM_SWCR_RX_MDNS_FILTER_CMD_T {
233 SWCR_RX_MDNS_FILTER_CMD_STOP = 0,
234 SWCR_RX_MDNS_FILTER_CMD_START,
235 SWCR_RX_MDNS_FILTER_CMD_ADD,
236 SWCR_RX_MDNS_FILTER_CMD_REMOVE,
237 SWCR_RX_MDNS_FILTER_NUM
238} ENUM_SWCR_RX_MDNS_FILTER_CMD_T;
239
240#if TEST_PS
241enum {
242 TEST_PS_MAGIC,
243 TEST_PS_SETUP_BSS,
244 TEST_PS_ENABLE_BEACON,
245 TEST_PS_TRIGGER_BMC,
246 TEST_PS_SEND_NULL,
247 TEST_PS_BUFFER_BMC,
248 TEST_PS_UPDATE_BEACON,
249 TEST_PS_CATA0_INDEX_NUM
250};
251
252enum {
253 TEST_PS_STA_PS,
254 TEST_PS_STA_ENTER_PS,
255 TEST_PS_STA_EXIT_PS,
256 TEST_PS_STA_TRIGGER_PSPOLL,
257 TEST_PS_STA_TRIGGER_FRAME,
258 TEST_PS_CATA1_INDEX_NUM
259};
260#endif
261
262#if CFG_SUPPORT_802_11V
263#if WNM_UNIT_TEST
264enum {
265 TEST_WNM_TIMING_MEAS,
266 TEST_WNM_CATA0_INDEX_NUM
267};
268#endif
269#endif
270
271
272#define _SWCTRL_MAGIC 0x66201642
273
274/*******************************************************************************
275* F U N C T I O N D E C L A R A T I O N S
276********************************************************************************
277*/
278
279
280/*******************************************************************************
281* F U N C T I O N S
282********************************************************************************
283*/
284
285void dumpQueue(P_ADAPTER_T prAdapter)
286{
287
288 P_TX_CTRL_T prTxCtrl;
289 P_QUE_MGT_T prQM;
290 P_GLUE_INFO_T prGlueInfo;
291 UINT_32 i;
292 UINT_32 j;
293
294
295 DEBUGFUNC("dumpQueue");
296
297 prTxCtrl = &prAdapter->rTxCtrl;
298 prQM = &prAdapter->rQM;
299 prGlueInfo = prAdapter->prGlueInfo;
300
301 for(i = TC0_INDEX; i<=TC5_INDEX; i++) {
302 DBGLOG(SW4, INFO,( "TC %u\n",i));
303 DBGLOG(SW4, INFO,( "Max %u Free %u\n",
304 prTxCtrl->rTc.aucMaxNumOfBuffer[i], prTxCtrl->rTc.aucFreeBufferCount[i]));
305
306 DBGLOG(SW4, INFO,("Average %u minReserved %u CurrentTcResource %u GuaranteedTcResource %u\n",
307 QM_GET_TX_QUEUE_LEN(prAdapter, i),
308 prQM->au4MinReservedTcResource[i],
309 prQM->au4CurrentTcResource[i],
310 prQM->au4GuaranteedTcResource[i]));
311
312 }
313
314
315 for(i = 0; i<NUM_OF_PER_STA_TX_QUEUES; i++) {
316 DBGLOG(SW4, INFO,( "TC %u HeadStaIdx %u ForwardCount %u\n",i, prQM->au4HeadStaRecIndex[i],prQM->au4ForwardCount[i]));
317 }
318
319 DBGLOG(SW4, INFO,( "BMC or unknown TxQueue Len %u\n",prQM->arTxQueue[0].u4NumElem));
320 DBGLOG(SW4, INFO,( "Pending %d\n",prGlueInfo->i4TxPendingFrameNum));
321 DBGLOG(SW4, INFO,( "Pending Security %d\n",prGlueInfo->i4TxPendingSecurityFrameNum));
322#if defined(LINUX)
323 for(i=0;i<4;i++){
324 for(j=0;j<CFG_MAX_TXQ_NUM;j++){
325 DBGLOG(SW4, INFO,( "Pending Q[%u][%u] %d\n",i,j,prGlueInfo->ai4TxPendingFrameNumPerQueue[i][j]));
326 }
327 }
328#endif
329
330 DBGLOG(SW4, INFO,( " rFreeSwRfbList %u\n", prAdapter->rRxCtrl.rFreeSwRfbList.u4NumElem));
331 DBGLOG(SW4, INFO,( " rReceivedRfbList %u\n", prAdapter->rRxCtrl.rReceivedRfbList.u4NumElem));
332 DBGLOG(SW4, INFO,( " rIndicatedRfbList %u\n", prAdapter->rRxCtrl.rIndicatedRfbList.u4NumElem));
333 DBGLOG(SW4, INFO,( " ucNumIndPacket %u\n", prAdapter->rRxCtrl.ucNumIndPacket));
334 DBGLOG(SW4, INFO,( " ucNumRetainedPacket %u\n", prAdapter->rRxCtrl.ucNumRetainedPacket));
335
336
337}
338
339
340void dumpSTA(P_ADAPTER_T prAdapter, P_STA_RECORD_T prStaRec)
341{
342 UINT_8 ucWTEntry;
343 UINT_32 i;
344 P_BSS_INFO_T prBssInfo;
345
346 DEBUGFUNC("dumpSTA");
347
348 ASSERT(prStaRec);
349 ucWTEntry = prStaRec->ucWTEntry;
350
351 prBssInfo = &prAdapter->rWifiVar.arBssInfo[prStaRec->ucNetTypeIndex];
352 ASSERT(prBssInfo);
353
354 DBGLOG(SW4, INFO,("Mac address: " MACSTR " Rcpi %u" "\n", MAC2STR(prStaRec->aucMacAddr),prStaRec->ucRCPI));
355
356 DBGLOG(SW4, INFO,("Idx %u Wtbl %u Used %u State %u Bss Phy 0x%x Sta DesiredPhy 0x%x\n",
357 prStaRec->ucIndex, ucWTEntry,
358 prStaRec->fgIsInUse,prStaRec->ucStaState,
359 prBssInfo->ucPhyTypeSet,
360 prStaRec->ucDesiredPhyTypeSet));
361
362 DBGLOG(SW4, INFO,("Sta Operation 0x%x DesiredNontHtRateSet 0x%x Mcs 0x%x u2HtCapInfo 0x%x\n",
363 prStaRec->u2OperationalRateSet,prStaRec->u2DesiredNonHTRateSet,prStaRec->ucMcsSet, prStaRec->u2HtCapInfo));
364
365
366 for(i = 0; i<NUM_OF_PER_STA_TX_QUEUES; i++) {
367 DBGLOG(SW4, INFO,( "TC %u Queue Len %u\n",i,prStaRec->arTxQueue[i].u4NumElem));
368 }
369
370 DBGLOG(SW4, INFO, ("BmpDeliveryAC %x\n",prStaRec->ucBmpDeliveryAC));
371 DBGLOG(SW4, INFO, ("BmpTriggerAC %x\n",prStaRec->ucBmpTriggerAC));
372 DBGLOG(SW4, INFO, ("UapsdSpSupproted %u\n",prStaRec->fgIsUapsdSupported));
373 DBGLOG(SW4, INFO, ("IsQoS %u\n",prStaRec->fgIsQoS));
374 DBGLOG(SW4, INFO, ("AssocId %u\n",prStaRec->u2AssocId));
375
376 DBGLOG(SW4, INFO, ("fgIsInPS %u\n",prStaRec->fgIsInPS));
377 DBGLOG(SW4, INFO, ("ucFreeQuota %u\n",prStaRec->ucFreeQuota));
378 DBGLOG(SW4, INFO, ("ucFreeQuotaForDelivery %u\n",prStaRec->ucFreeQuotaForDelivery));
379 DBGLOG(SW4, INFO, ("ucFreeQuotaForNonDelivery %u\n",prStaRec->ucFreeQuotaForNonDelivery));
380
381
382#if 0
383 DBGLOG(SW4, INFO, ("IsQmmSup %u\n",prStaRec->fgIsWmmSupported));
384 DBGLOG(SW4, INFO, ("IsUapsdSup %u\n",prStaRec->fgIsUapsdSupported));
385 DBGLOG(SW4, INFO, ("AvailabaleDeliverPkts %u\n",prStaRec->ucAvailableDeliverPkts));
386 DBGLOG(SW4, INFO, ("BmpDeliverPktsAC %u\n",prStaRec->u4BmpDeliverPktsAC));
387 DBGLOG(SW4, INFO, ("BmpBufferAC %u\n",prStaRec->u4BmpBufferAC));
388 DBGLOG(SW4, INFO, ("BmpNonDeliverPktsAC %u\n",prStaRec->u4BmpNonDeliverPktsAC));
389#endif
390
391 for(i=0;i<CFG_RX_MAX_BA_TID_NUM;i++) {
392 if(prStaRec->aprRxReorderParamRefTbl[i]){
393 DBGLOG(SW4, INFO,("RxReorder fgIsValid: %u\n",prStaRec->aprRxReorderParamRefTbl[i]->fgIsValid));
394 DBGLOG(SW4, INFO,("RxReorder Tid: %u\n",prStaRec->aprRxReorderParamRefTbl[i]->ucTid));
395 DBGLOG(SW4, INFO,("RxReorder rReOrderQue Len: %u\n", prStaRec->aprRxReorderParamRefTbl[i]->rReOrderQue.u4NumElem));
396 DBGLOG(SW4, INFO,("RxReorder WinStart: %u\n", prStaRec->aprRxReorderParamRefTbl[i]->u2WinStart));
397 DBGLOG(SW4, INFO,("RxReorder WinEnd: %u\n", prStaRec->aprRxReorderParamRefTbl[i]->u2WinEnd));
398 DBGLOG(SW4, INFO,("RxReorder WinSize: %u\n", prStaRec->aprRxReorderParamRefTbl[i]->u2WinSize));
399 }
400 }
401
402}
403
404
405VOID dumpBss(P_ADAPTER_T prAdapter, P_BSS_INFO_T prBssInfo)
406{
407
408 DBGLOG(SW4, INFO, ("SSID %s\n",prBssInfo->aucSSID));
409 DBGLOG(SW4, INFO, ("OWN " MACSTR"\n",MAC2STR(prBssInfo->aucOwnMacAddr)));
410 DBGLOG(SW4, INFO, ("BSSID " MACSTR"\n",MAC2STR(prBssInfo->aucBSSID)));
411 DBGLOG(SW4, INFO, ("ucNetTypeIndex %u\n",prBssInfo->ucNetTypeIndex));
412 DBGLOG(SW4, INFO, ("eConnectionState %u\n",prBssInfo->eConnectionState));
413 DBGLOG(SW4, INFO, ("eCurrentOPMode %u\n",prBssInfo->eCurrentOPMode));
414 DBGLOG(SW4, INFO, ("fgIsQBSS %u\n",prBssInfo->fgIsQBSS));
415 DBGLOG(SW4, INFO, ("fgIsShortPreambleAllowed %u\n",prBssInfo->fgIsShortPreambleAllowed));
416 DBGLOG(SW4, INFO, ("fgUseShortPreamble %u\n",prBssInfo->fgUseShortPreamble));
417 DBGLOG(SW4, INFO, ("fgUseShortSlotTime %u\n",prBssInfo->fgUseShortSlotTime));
418 DBGLOG(SW4, INFO, ("ucNonHTBasicPhyType %x\n",prBssInfo->ucNonHTBasicPhyType));
419 DBGLOG(SW4, INFO, ("u2OperationalRateSet %x\n",prBssInfo->u2OperationalRateSet));
420 DBGLOG(SW4, INFO, ("u2BSSBasicRateSet %x\n",prBssInfo->u2BSSBasicRateSet));
421 DBGLOG(SW4, INFO, ("ucPhyTypeSet %x\n",prBssInfo->ucPhyTypeSet));
422 DBGLOG(SW4, INFO, ("rStaRecOfClientList %d\n",prBssInfo->rStaRecOfClientList.u4NumElem));
423 DBGLOG(SW4, INFO, ("u2CapInfo %x\n",prBssInfo->u2CapInfo));
424 DBGLOG(SW4, INFO, ("u2ATIMWindow %x\n",prBssInfo->u2ATIMWindow));
425 DBGLOG(SW4, INFO, ("u2AssocId %x\n",prBssInfo->u2AssocId));
426 DBGLOG(SW4, INFO, ("ucDTIMPeriod %x\n",prBssInfo->ucDTIMPeriod));
427 DBGLOG(SW4, INFO, ("ucDTIMCount %x\n",prBssInfo->ucDTIMCount));
428 DBGLOG(SW4, INFO, ("fgIsNetAbsent %x\n", prBssInfo->fgIsNetAbsent));
429 DBGLOG(SW4, INFO, ("eBand %d\n", prBssInfo->eBand));
430 DBGLOG(SW4, INFO, ("ucPrimaryChannel %d\n", prBssInfo->ucPrimaryChannel));
431 DBGLOG(SW4, INFO, ("ucHtOpInfo1 %d\n", prBssInfo->ucHtOpInfo1));
432 DBGLOG(SW4, INFO, ("ucHtOpInfo2 %d\n", prBssInfo->u2HtOpInfo2));
433 DBGLOG(SW4, INFO, ("ucHtOpInfo3 %d\n", prBssInfo->u2HtOpInfo3));
434 DBGLOG(SW4, INFO, ("fgErpProtectMode %d\n", prBssInfo->fgErpProtectMode));
435 DBGLOG(SW4, INFO, ("eHtProtectMode %d\n", prBssInfo->eHtProtectMode));
436 DBGLOG(SW4, INFO, ("eGfOperationMode %d\n", prBssInfo->eGfOperationMode));
437 DBGLOG(SW4, INFO, ("eRifsOperationMode %d\n", prBssInfo->eRifsOperationMode));
438 DBGLOG(SW4, INFO, ("fgObssErpProtectMode %d\n", prBssInfo->fgObssErpProtectMode));
439 DBGLOG(SW4, INFO, ("eObssHtProtectMode %d\n", prBssInfo->eObssHtProtectMode));
440 DBGLOG(SW4, INFO, ("eObssGfProtectMode %d\n", prBssInfo->eObssGfOperationMode));
441 DBGLOG(SW4, INFO, ("fgObssRifsOperationMode %d\n", prBssInfo->fgObssRifsOperationMode));
442 DBGLOG(SW4, INFO, ("fgAssoc40mBwAllowed %d\n", prBssInfo->fgAssoc40mBwAllowed));
443 DBGLOG(SW4, INFO, ("fg40mBwAllowed %d\n", prBssInfo->fg40mBwAllowed));
444 DBGLOG(SW4, INFO, ("eBssSCO %d\n", prBssInfo->eBssSCO));
445
446
447}
448
449
450
451VOID swCtrlCmdCategory0(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1)
452{
453 UINT_8 ucIndex,ucRead;
454 UINT_32 i;
455
456 DEBUGFUNC("swCtrlCmdCategory0");
457
458 SWCR_GET_RW_INDEX(ucAction,ucRead,ucIndex);
459
460 i=0;
461
462 if(ucIndex>=SWCTRL_CATA0_INDEX_NUM) return;
463
464 if(ucRead == SWCR_WRITE) {
465 switch(ucIndex) {
466 case SWCTRL_DEBUG:
467#if DBG
468 aucDebugModule[ucOpt0] = (UINT_8)g_au4SwCr[1];
469#endif
470 break;
471 case SWCTRL_WIFI_VAR:
472 break;
473
474#if QM_DEBUG_COUNTER
475 case SWCTRL_DUMP_QM_DBG_CNT:
476 for(i=0;i<QM_DBG_CNT_NUM;i++) {
477 prAdapter->rQM.au4QmDebugCounters[i] = 0;
478 }
479 break;
480 case SWCTRL_QM_DBG_CNT:
481 prAdapter->rQM.au4QmDebugCounters[ucOpt0] = g_au4SwCr[1];
482
483 break;
484#endif
485#if CFG_RX_PKTS_DUMP
486 case SWCTRL_RX_PKTS_DUMP:
487 //DBGLOG(SW4, INFO,("SWCTRL_RX_PKTS_DUMP: mask %x\n", g_au4SwCr[1]));
488 prAdapter->rRxCtrl.u4RxPktsDumpTypeMask = g_au4SwCr[1];
489 break;
490#endif
491 case SWCTRL_RX_MDNS_FILTER:
492 {
493 UINT_32 u4rxfilter;
494 BOOLEAN fgUpdate = FALSE;
495 WLAN_STATUS rStatus = WLAN_STATUS_SUCCESS;
496
497 if (ucOpt0 == SWCR_RX_MDNS_FILTER_CMD_STOP) {
498 g_u4mDNSRXFilter &= ~(RX_MDNS_FILTER_START);
499
500 u4rxfilter = prAdapter->u4OsPacketFilter;
501 fgUpdate = TRUE;
502 }
503 else if (ucOpt0 == SWCR_RX_MDNS_FILTER_CMD_START) {
504 g_u4mDNSRXFilter |= (RX_MDNS_FILTER_START);
505
506 u4rxfilter = prAdapter->u4OsPacketFilter;
507 if ((g_u4mDNSRXFilter & RX_MDNS_FILTER_IPV4) ||
508 (g_u4mDNSRXFilter & RX_MDNS_FILTER_IPV6)) {
509 u4rxfilter |= PARAM_PACKET_FILTER_ALL_MULTICAST;
510 }
511 fgUpdate = TRUE;
512 }
513 else if (ucOpt0 == SWCR_RX_MDNS_FILTER_CMD_ADD) {
514 if (ucOpt1 < 31) {
515 g_u4mDNSRXFilter |= (1<<ucOpt1);
516 }
517 }
518 else if (ucOpt0 == SWCR_RX_MDNS_FILTER_CMD_REMOVE) {
519 if (ucOpt1 < 31) {
520 g_u4mDNSRXFilter &= ~(1<<ucOpt1);
521 }
522 }
523
524 if (fgUpdate == TRUE) {
525 rStatus = wlanSendSetQueryCmd (
526 prAdapter, /* prAdapter */
527 CMD_ID_SET_RX_FILTER, /* ucCID */
528 TRUE, /* fgSetQuery */
529 FALSE, /* fgNeedResp */
530 FALSE, /* fgIsOid */
531 NULL, /* pfCmdDoneHandler */
532 NULL, /* pfCmdTimeoutHandler */
533 sizeof(UINT_32), /* u4SetQueryInfoLen */
534 (PUINT_8) &u4rxfilter, /* pucInfoBuffer */
535 NULL, /* pvSetQueryBuffer */
536 0 /* un4SetQueryBufferLen */
537 );
538 }
539//DBGLOG(SW4, INFO,("SWCTRL_RX_MDNS_FILTER: g_u4mDNSRXFilter %x ucOpt0 %x ucOpt1 %x fgUpdate %x u4rxfilter %x, rStatus %x\n",
540// g_u4mDNSRXFilter, ucOpt0, ucOpt1, fgUpdate, u4rxfilter, rStatus));
541 }
542 break;
543 default:
544 break;
545 }
546 }
547 else {
548 switch(ucIndex) {
549 case SWCTRL_DEBUG:
550#if DBG
551 g_au4SwCr[1] = aucDebugModule[ucOpt0] ;
552#endif
553 break;
554 case SWCTRL_MAGIC:
555 g_au4SwCr[1] = _SWCTRL_MAGIC ;
556 DBGLOG(SW4, INFO,("BUILD TIME: %s %s\n", __DATE__, __TIME__));
557 break;
558 case SWCTRL_QM_INFO:
559 {
560 P_QUE_MGT_T prQM = &prAdapter->rQM;
561 switch(ucOpt0) {
562 case 0:
563 g_au4SwCr[1] = (QM_GET_TX_QUEUE_LEN(prAdapter, ucOpt1)) ;
564 g_au4SwCr[2] = prQM->au4MinReservedTcResource[ucOpt1] ;
565 g_au4SwCr[3] = prQM->au4CurrentTcResource[ucOpt1];
566 g_au4SwCr[4] = prQM->au4GuaranteedTcResource[ucOpt1];
567 break;
568
569 case 1:
570 g_au4SwCr[1] = prQM->au4ForwardCount[ucOpt1];
571 g_au4SwCr[2] = prQM->au4HeadStaRecIndex[ucOpt1];
572 break;
573
574 case 2:
575 g_au4SwCr[1] = prQM->arTxQueue[ucOpt1].u4NumElem; /* only one */
576
577
578 break;
579 }
580
581 }
582 case SWCTRL_TX_CTRL_INFO:
583 {
584 P_TX_CTRL_T prTxCtrl;
585 prTxCtrl = &prAdapter->rTxCtrl;
586 switch(ucOpt0) {
587 case 0:
588 g_au4SwCr[1] = prAdapter->rTxCtrl.rTc.aucFreeBufferCount[ucOpt1];
589 g_au4SwCr[2] = prAdapter->rTxCtrl.rTc.aucMaxNumOfBuffer[ucOpt1];
590 break;
591 }
592
593 }
594 break;
595 case SWCTRL_DUMP_QUEUE:
596 dumpQueue(prAdapter);
597
598 break;
599#if QM_DEBUG_COUNTER
600 case SWCTRL_DUMP_QM_DBG_CNT:
601 for(i=0;i<QM_DBG_CNT_NUM;i++) {
602 DBGLOG(SW4, INFO,("QM:DBG %u %u\n",i , prAdapter->rQM.au4QmDebugCounters[i]));
603 }
604 break;
605
606 case SWCTRL_QM_DBG_CNT:
607 g_au4SwCr[1] = prAdapter->rQM.au4QmDebugCounters[ucOpt0];
608 break;
609#endif
610 case SWCTRL_DUMP_BSS:
611 {
612 dumpBss(prAdapter, &(prAdapter->rWifiVar.arBssInfo[ucOpt0])) ;
613 }
614 break;
615
616 default:
617 break;
618 }
619
620 }
621}
622
623
624VOID swCtrlCmdCategory1(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1)
625{
626 UINT_8 ucIndex,ucRead;
627 UINT_8 ucWTEntry;
628 P_STA_RECORD_T prStaRec;
629
630 DEBUGFUNC("swCtrlCmdCategory1");
631
632 SWCR_GET_RW_INDEX(ucAction,ucRead,ucIndex);
633
634 if(ucOpt0>=CFG_STA_REC_NUM) return;
635
636 //prStaRec = cnmGetStaRecByIndex (prAdapter, ucOpt0);
637 prStaRec = &prAdapter->arStaRec[ucOpt0];
638 ucWTEntry = prStaRec->ucWTEntry;
639 if(ucRead == SWCR_WRITE) {
640 }
641 else {
642 /* Read */
643 switch(ucIndex) {
644 case SWCTRL_STA_QUE_INFO:
645 {
646 g_au4SwCr[1] = prStaRec->arTxQueue[ucOpt1].u4NumElem;
647 }
648 break;
649 case SWCTRL_STA_INFO:
650 switch(ucOpt1) {
651 case 0:
652 g_au4SwCr[1] = prStaRec->fgIsInPS;
653 break;
654 }
655
656 break;
657
658 case SWCTRL_DUMP_STA:
659 {
660 dumpSTA(prAdapter, prStaRec);
661 }
662 break;
663
664 default:
665
666 break;
667 }
668 }
669
670
671}
672
673#if TEST_PS
674
675VOID
676testPsSendQoSNullFrame (
677 IN P_ADAPTER_T prAdapter,
678 IN P_STA_RECORD_T prStaRec,
679 IN UINT_8 ucUP,
680 IN UINT_8 ucNetTypeIndex,
681 IN BOOLEAN fgBMC,
682 IN BOOLEAN fgIsBurstEnd,
683 IN BOOLEAN ucPacketType,
684 IN BOOLEAN ucPsSessionID,
685 IN BOOLEAN fgSetEOSP
686 )
687{
688 P_MSDU_INFO_T prMsduInfo;
689 UINT_16 u2EstimatedFrameLen;
690 P_WLAN_MAC_HEADER_QOS_T prQoSNullFrame;
691
692
693 DEBUGFUNC("testPsSendQoSNullFrame");
694 DBGLOG(SW4, LOUD, ("\n"));
695
696 //4 <1> Allocate a PKT_INFO_T for Null Frame
697 /* Init with MGMT Header Length */
698 u2EstimatedFrameLen = MAC_TX_RESERVED_FIELD + \
699 WLAN_MAC_HEADER_QOS_LEN;
700
701 /* Allocate a MSDU_INFO_T */
702 if ( (prMsduInfo = cnmMgtPktAlloc(prAdapter, u2EstimatedFrameLen)) == NULL) {
703 DBGLOG(SW4, WARN, ("No PKT_INFO_T for sending Null Frame.\n"));
704 return ;
705 }
706
707 //4 <2> Compose Null frame in MSDU_INfO_T.
708 bssComposeQoSNullFrame(prAdapter,
709 (PUINT_8)((ULONG)(prMsduInfo->prPacket) + MAC_TX_RESERVED_FIELD),
710 prStaRec,
711 ucUP,
712 fgSetEOSP);
713
714
715 prMsduInfo->eSrc = TX_PACKET_MGMT;
716 //prMsduInfo->ucPacketType = HIF_TX_PACKET_TYPE_DATA;
717 prMsduInfo->ucPacketType = ucPacketType;
718 prMsduInfo->ucStaRecIndex = prStaRec->ucIndex;
719 prMsduInfo->ucNetworkType = ucNetTypeIndex;
720 prMsduInfo->ucMacHeaderLength = WLAN_MAC_HEADER_QOS_LEN;
721 prMsduInfo->fgIs802_1x = FALSE;
722 prMsduInfo->fgIs802_11 = TRUE;
723 prMsduInfo->u2FrameLength = WLAN_MAC_HEADER_QOS_LEN;
724 prMsduInfo->ucTxSeqNum = nicIncreaseTxSeqNum(prAdapter);
725 prMsduInfo->pfTxDoneHandler = NULL;
726 prMsduInfo->fgIsBasicRate = TRUE;
727 prMsduInfo->fgIsBurstEnd = fgIsBurstEnd;
728 prMsduInfo->ucUserPriority = ucUP;
729 prMsduInfo->ucPsSessionID = ucPsSessionID /* 0~7 Test 7 means NOACK*/;
730
731 prQoSNullFrame = (P_WLAN_MAC_HEADER_QOS_T)(((ULONG)(prMsduInfo->prPacket) + MAC_TX_RESERVED_FIELD));
732
733 if(fgBMC) {
734 prQoSNullFrame->aucAddr1[0] = 0xfd;
735 }
736 else {
737 prQoSNullFrame->aucAddr1[5] = 0xdd;
738 }
739
740 //4 <4> Inform TXM to send this Null frame.
741 nicTxEnqueueMsdu(prAdapter, prMsduInfo);
742
743}
744
745
746
747VOID
748testPsSetupBss(
749 IN P_ADAPTER_T prAdapter,
750 IN UINT_8 ucNetworkTypeIndex
751 )
752{
753 P_BSS_INFO_T prBssInfo;
754 UINT_8 _aucZeroMacAddr[] = NULL_MAC_ADDR;
755
756 DEBUGFUNC("testPsSetupBss()");
757 DBGLOG(SW4, INFO, ("index %d\n", ucNetworkTypeIndex));
758
759 prBssInfo = &(prAdapter->rWifiVar.arBssInfo[ucNetworkTypeIndex]);
760
761 //4 <1.2> Initiate PWR STATE
762 //SET_NET_PWR_STATE_IDLE(prAdapter, ucNetworkTypeIndex);
763
764
765 //4 <2> Initiate BSS_INFO_T - common part
766 BSS_INFO_INIT(prAdapter, ucNetworkTypeIndex);
767
768 prBssInfo->eConnectionState = PARAM_MEDIA_STATE_DISCONNECTED;
769 prBssInfo->eConnectionStateIndicated = PARAM_MEDIA_STATE_DISCONNECTED;
770 prBssInfo->eCurrentOPMode = OP_MODE_ACCESS_POINT;
771 prBssInfo->fgIsNetActive = TRUE;
772 prBssInfo->ucNetTypeIndex = (ucNetworkTypeIndex);
773 prBssInfo->ucReasonOfDisconnect = DISCONNECT_REASON_CODE_RESERVED;
774
775 prBssInfo->ucPhyTypeSet = PHY_TYPE_SET_802_11BG; /* Depend on eBand */
776 prBssInfo->ucConfigAdHocAPMode = AP_MODE_MIXED_11BG; /* Depend on eCurrentOPMode and ucPhyTypeSet */
777 prBssInfo->u2BSSBasicRateSet = RATE_SET_ERP;
778 prBssInfo->u2OperationalRateSet = RATE_SET_OFDM;
779 prBssInfo->fgErpProtectMode = FALSE;
780 prBssInfo->fgIsQBSS = TRUE;
781
782 //4 <1.5> Setup MIB for current BSS
783 prBssInfo->u2BeaconInterval = 100;
784 prBssInfo->ucDTIMPeriod = DOT11_DTIM_PERIOD_DEFAULT;
785 prBssInfo->u2ATIMWindow = 0;
786
787 prBssInfo->ucBeaconTimeoutCount = 0;
788
789
790 bssInitForAP (prAdapter,prBssInfo, TRUE);
791
792 COPY_MAC_ADDR(prBssInfo->aucBSSID, _aucZeroMacAddr);
793 LINK_INITIALIZE(&prBssInfo->rStaRecOfClientList);
794 prBssInfo->fgIsBeaconActivated = TRUE;
795 prBssInfo->ucHwDefaultFixedRateCode = RATE_CCK_1M_LONG;
796
797
798 COPY_MAC_ADDR(prBssInfo->aucOwnMacAddr, prAdapter->rWifiVar.aucMacAddress);
799
800 //4 <3> Initiate BSS_INFO_T - private part
801 /* TODO */
802 prBssInfo->eBand = BAND_2G4;
803 prBssInfo->ucPrimaryChannel = 1;
804 prBssInfo->prStaRecOfAP = (P_STA_RECORD_T)NULL;
805
806
807 //prBssInfo->fgErpProtectMode = eErpProectMode;
808 //prBssInfo->eHtProtectMode = eHtProtectMode;
809 //prBssInfo->eGfOperationMode = eGfOperationMode;
810
811
812 //4 <4> Allocate MSDU_INFO_T for Beacon
813 prBssInfo->prBeacon = cnmMgtPktAlloc(prAdapter,
814 OFFSET_OF(WLAN_BEACON_FRAME_T, aucInfoElem[0]) + MAX_IE_LENGTH);
815
816 if (prBssInfo->prBeacon) {
817 prBssInfo->prBeacon->eSrc = TX_PACKET_MGMT;
818 prBssInfo->prBeacon->ucNetworkType = ucNetworkTypeIndex;
819 }
820 else {
821 DBGLOG(SW4, INFO, ("prBeacon allocation fail\n"));
822 }
823
824#if 0
825 prBssInfo->rPmProfSetupInfo.ucBmpDeliveryAC = PM_UAPSD_ALL;
826 prBssInfo->rPmProfSetupInfo.ucBmpTriggerAC = PM_UAPSD_ALL;
827 prBssInfo->rPmProfSetupInfo.ucUapsdSp = WMM_MAX_SP_LENGTH_2;
828#else
829 prBssInfo->rPmProfSetupInfo.ucBmpDeliveryAC = (UINT_8)prAdapter->u4UapsdAcBmp;
830 prBssInfo->rPmProfSetupInfo.ucBmpTriggerAC =(UINT_8) prAdapter->u4UapsdAcBmp;
831 prBssInfo->rPmProfSetupInfo.ucUapsdSp = (UINT_8)prAdapter->u4MaxSpLen;
832#endif
833
834#if 0
835 for(eAci = 0; eAci < WMM_AC_INDEX_NUM; eAci++){
836
837 prBssInfo->arACQueParms[eAci].fgIsACMSet = FALSE;
838 prBssInfo->arACQueParms[eAci].u2Aifsn = (UINT_16) eAci;
839 prBssInfo->arACQueParms[eAci].u2CWmin = 7;
840 prBssInfo->arACQueParms[eAci].u2CWmax = 31;
841 prBssInfo->arACQueParms[eAci].u2TxopLimit = eAci+1;
842 DBGLOG(SW4, INFO, ("MQM: eAci = %d, ACM = %d, Aifsn = %d, CWmin = %d, CWmax = %d, TxopLimit = %d\n",
843 eAci,prBssInfo->arACQueParms[eAci].fgIsACMSet ,
844 prBssInfo->arACQueParms[eAci].u2Aifsn,
845 prBssInfo->arACQueParms[eAci].u2CWmin,
846 prBssInfo->arACQueParms[eAci].u2CWmax,
847 prBssInfo->arACQueParms[eAci].u2TxopLimit));
848
849 }
850#endif
851
852
853 DBGLOG(SW4, INFO, ("[2] ucBmpDeliveryAC:0x%x, ucBmpTriggerAC:0x%x, ucUapsdSp:0x%x",
854 prBssInfo->rPmProfSetupInfo.ucBmpDeliveryAC,
855 prBssInfo->rPmProfSetupInfo.ucBmpTriggerAC,
856 prBssInfo->rPmProfSetupInfo.ucUapsdSp));
857
858 return;
859}
860
861
862
863
864VOID testPsCmdCategory0(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1)
865{
866 UINT_8 ucIndex,ucRead;
867 P_STA_RECORD_T prStaRec;
868
869 DEBUGFUNC("testPsCmdCategory0");
870 SWCR_GET_RW_INDEX(ucAction,ucRead,ucIndex);
871
872 DBGLOG(SW4, LOUD, ("Read %u Index %u\n",ucRead,ucIndex));
873
874 prStaRec = cnmGetStaRecByIndex (prAdapter, 0);
875
876 if(ucIndex>=TEST_PS_CATA0_INDEX_NUM) return;
877
878 if(ucRead == SWCR_WRITE) {
879 switch(ucIndex) {
880 case TEST_PS_SETUP_BSS:
881 testPsSetupBss(prAdapter, ucOpt0) ;
882 break;
883
884 case TEST_PS_ENABLE_BEACON:
885 break;
886
887 case TEST_PS_TRIGGER_BMC:
888 //txmForwardQueuedBmcPkts (ucOpt0);
889 break;
890 case TEST_PS_SEND_NULL:
891 {
892
893 testPsSendQoSNullFrame (prAdapter,prStaRec,
894 (UINT_8)(g_au4SwCr[1] & 0xFF), /* UP */
895 ucOpt0,
896 (BOOLEAN)((g_au4SwCr[1] >>8)& 0xFF), /* BMC*/
897 (BOOLEAN)((g_au4SwCr[1] >>16)& 0xFF), /* BurstEnd*/
898 (BOOLEAN)((g_au4SwCr[1] >>24)& 0xFF), /* Packet type*/
899 (UINT_8)((g_au4SwCr[2] )& 0xFF), /* PS sesson ID 7: NOACK */
900 FALSE /* EOSP */
901 );
902 }
903 break;
904 case TEST_PS_BUFFER_BMC:
905 //g_aprBssInfo[ucOpt0]->fgApToBufferBMC = (g_au4SwCr[1] & 0xFF);
906 break;
907 case TEST_PS_UPDATE_BEACON:
908 bssUpdateBeaconContent(prAdapter, ucOpt0 /*networktype*/ );
909 break;
910
911 default:
912 break;
913 }
914 }
915 else {
916 switch(ucIndex) {
917
918 case TEST_PS_MAGIC:
919 g_au4SwCr[1] = 0x88660011 ;
920 break;
921
922 }
923 }
924}
925
926#endif //TEST_PS
927
928#if TEST_PS
929
930VOID testPsCmdCategory1(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1)
931{
932 UINT_8 ucIndex,ucRead;
933 UINT_8 ucWTEntry;
934 P_STA_RECORD_T prStaRec;
935
936 DEBUGFUNC("testPsCmdCategory1");
937
938 SWCR_GET_RW_INDEX(ucAction,ucRead,ucIndex);
939
940 if(ucOpt0>=CFG_STA_REC_NUM) return;
941
942 prStaRec = cnmGetStaRecByIndex (prAdapter, ucOpt0);
943 ucWTEntry = prStaRec->ucWTEntry;
944 if(ucRead == SWCR_WRITE) {
945
946 switch(ucIndex) {
947 case TEST_PS_STA_PS:
948 prStaRec->fgIsInPS = (BOOLEAN) (g_au4SwCr[1] & 0x1);
949 prStaRec->fgIsQoS = (BOOLEAN) (g_au4SwCr[1] >>8 & 0xFF);
950 prStaRec->fgIsUapsdSupported = (BOOLEAN) (g_au4SwCr[1] >>16 & 0xFF);
951 prStaRec->ucBmpDeliveryAC = (BOOLEAN) (g_au4SwCr[1] >>24 & 0xFF);
952 break;
953
954 }
955
956 }
957 else {
958 /* Read */
959 switch(ucIndex) {
960 default:
961 break;
962 }
963 }
964
965
966}
967
968#endif //TEST_PS
969
970#if CFG_SUPPORT_802_11V
971#if (CFG_SUPPORT_802_11V_TIMING_MEASUREMENT ==1) && (WNM_UNIT_TEST ==1)
972VOID testWNMCmdCategory0(P_ADAPTER_T prAdapter, UINT_8 ucCate, UINT_8 ucAction, UINT_8 ucOpt0,UINT_8 ucOpt1)
973{
974 UINT_8 ucIndex,ucRead;
975 P_STA_RECORD_T prStaRec;
976
977 DEBUGFUNC("testWNMCmdCategory0");
978 SWCR_GET_RW_INDEX(ucAction,ucRead,ucIndex);
979
980 DBGLOG(SW4, INFO, ("Read %u Index %u\n",ucRead,ucIndex));
981
982 if(ucIndex>=TEST_WNM_CATA0_INDEX_NUM) return;
983
984 if(ucRead == SWCR_WRITE) {
985 switch(ucIndex) {
986 case TEST_WNM_TIMING_MEAS:
987 wnmTimingMeasUnitTest1(prAdapter, ucOpt0) ;
988 break;
989
990 default:
991 break;
992 }
993 }
994}
995#endif //TEST_WNM
996#endif //CFG_SUPPORT_802_11V
997
998VOID swCtrlSwCr(P_ADAPTER_T prAdapter, UINT_8 ucRead, UINT_16 u2Addr, UINT_32 *pu4Data)
999{
1000 /* According other register STAIDX */
1001 UINT_8 ucOffset;
1002 ucOffset = (u2Addr>>2) & 0x3F;
1003
1004 if(ucOffset>= SWCR_CR_NUM) return;
1005
1006 if(ucRead==SWCR_WRITE) {
1007 g_au4SwCr[ucOffset] = *pu4Data;
1008 if(ucOffset==0x0) {
1009 /* Commmand [31:24]: Category */
1010 /* Commmand [23:23]: 1(W) 0(R) */
1011 /* Commmand [22:16]: Index */
1012 /* Commmand [15:08]: Option0 */
1013 /* Commmand [07:00]: Option1 */
1014 UINT_8 ucCate;
1015 UINT_32 u4Cmd;
1016 u4Cmd = g_au4SwCr[0];
1017 ucCate = (UINT_8)(u4Cmd >> 24) ;
1018 if(ucCate < sizeof(g_arSwCtrlCmd)/sizeof(g_arSwCtrlCmd[0])) {
1019 if(g_arSwCtrlCmd[ucCate]!=NULL) {
1020 g_arSwCtrlCmd[ucCate](prAdapter, ucCate, (UINT_8)(u4Cmd>>16 & 0xFF),(UINT_8)((u4Cmd>>8) & 0xFF), (UINT_8)(u4Cmd&0xFF));
1021 }
1022 }
1023 }
1024 }
1025 else {
1026 *pu4Data = g_au4SwCr[ucOffset];
1027 }
1028}
1029
1030VOID swCrReadWriteCmd(P_ADAPTER_T prAdapter, UINT_8 ucRead, UINT_16 u2Addr, UINT_32 *pu4Data)
1031{
1032 UINT_8 ucMod;
1033
1034 ucMod = u2Addr >>8;
1035 /* Address [15:8] MOD ID */
1036 /* Address [7:0] OFFSET */
1037
1038 DEBUGFUNC("swCrReadWriteCmd");
1039 DBGLOG(SW4, INFO, ("%u addr 0x%x data 0x%x\n",ucRead,u2Addr,*pu4Data));
1040
1041 if(ucMod < (sizeof(g_arSwCrModHandle)/sizeof(g_arSwCrModHandle[0])) ) {
1042
1043 if(g_arSwCrModHandle[ucMod]!=NULL) {
1044 g_arSwCrModHandle[ucMod](prAdapter, ucRead, u2Addr, pu4Data);
1045 }
1046 } /* ucMod */
1047}
1048
1049/* Debug Support */
1050VOID swCrFrameCheckEnable(P_ADAPTER_T prAdapter, UINT_32 u4DumpType)
1051{
1052 g_u4SwcrDebugFrameDumpType = u4DumpType;
1053 prAdapter->rRxCtrl.u4RxPktsDumpTypeMask = u4DumpType;
1054}
1055
1056VOID swCrDebugInit(P_ADAPTER_T prAdapter)
1057{
1058 // frame dump
1059 if (g_u4SwcrDebugFrameDumpType) {
1060 swCrFrameCheckEnable(prAdapter, g_u4SwcrDebugFrameDumpType);
1061 }
1062
1063 // debug counter
1064 g_fgSwcrDebugTimer = FALSE;
1065
1066 cnmTimerInitTimer(prAdapter,
1067 &g_rSwcrDebugTimer,
1068 (PFN_MGMT_TIMEOUT_FUNC)swCrDebugCheckTimeout,
1069 (ULONG) NULL);
1070
1071 if (g_u4SwcrDebugCheckTimeout) {
1072 swCrDebugCheckEnable(prAdapter, TRUE, g_ucSwcrDebugCheckType, g_u4SwcrDebugCheckTimeout);
1073 }
1074}
1075
1076VOID swCrDebugUninit(P_ADAPTER_T prAdapter)
1077{
1078 cnmTimerStopTimer(prAdapter, &g_rSwcrDebugTimer);
1079
1080 g_fgSwcrDebugTimer = FALSE;
1081}
1082
1083VOID swCrDebugCheckEnable(P_ADAPTER_T prAdapter, BOOLEAN fgIsEnable, UINT_8 ucType, UINT_32 u4Timeout)
1084{
1085 if (fgIsEnable) {
1086 g_ucSwcrDebugCheckType = ucType;
1087 g_u4SwcrDebugCheckTimeout = u4Timeout;
1088 if (g_fgSwcrDebugTimer == FALSE) {
1089 swCrDebugCheckTimeout(prAdapter, 0);
1090 }
1091 }
1092 else {
1093 cnmTimerStopTimer(prAdapter, &g_rSwcrDebugTimer);
1094 g_u4SwcrDebugCheckTimeout = 0;
1095 }
1096
1097 g_fgSwcrDebugTimer = fgIsEnable;
1098}
1099
1100VOID swCrDebugCheck(P_ADAPTER_T prAdapter, P_CMD_SW_DBG_CTRL_T prCmdSwCtrl)
1101{
1102 P_RX_CTRL_T prRxCtrl;
1103 P_TX_CTRL_T prTxCtrl;
1104
1105 ASSERT(prAdapter);
1106
1107 prTxCtrl = &prAdapter->rTxCtrl;
1108 prRxCtrl = &prAdapter->rRxCtrl;
1109
1110 // dump counters
1111 if (prCmdSwCtrl) {
1112 if (prCmdSwCtrl->u4Data == SWCR_DBG_TYPE_ALL) {
1113
1114 // TX Counter from fw
1115 DBGLOG(SW4, INFO, ("TX0\n" \
1116 "%08x %08x %08x %08x\n" \
1117 "%08x %08x %08x %08x\n",
1118 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_CNT],
1119 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_BCN_CNT],
1120 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_FAILED_CNT],
1121 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_RETRY_CNT],
1122 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_AGING_TIMEOUT_CNT],
1123 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_PS_OVERFLOW_CNT],
1124 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_MGNT_DROP_CNT],
1125 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_TX_ERROR_CNT]));
1126#if 1
1127 // TX Counter from drv
1128 DBGLOG(SW4, INFO, ("TX1\n" \
1129 "%08x %08x %08x %08x\n",
1130 (UINT_32)TX_GET_CNT(prTxCtrl, TX_INACTIVE_BSS_DROP),
1131 (UINT_32)TX_GET_CNT(prTxCtrl, TX_INACTIVE_STA_DROP),
1132 (UINT_32)TX_GET_CNT(prTxCtrl, TX_FORWARD_OVERFLOW_DROP),
1133 (UINT_32)TX_GET_CNT(prTxCtrl, TX_AP_BORADCAST_DROP)));
1134#endif
1135
1136 // RX Counter
1137 DBGLOG(SW4, INFO, ("RX0\n" \
1138 "%08x %08x %08x %08x\n" \
1139 "%08x %08x %08x %08x\n" \
1140 "%08x %08x %08x %08x\n" \
1141 "%08x %08x %08x %08x\n",
1142 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_CNT],
1143 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_DROP_CNT],
1144 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_DUP_DROP_CNT],
1145 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_TYPE_ERROR_DROP_CNT],
1146 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_CLASS_ERROR_DROP_CNT],
1147 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_AMPDU_ERROR_DROP_CNT],
1148 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_STATUS_ERROR_DROP_CNT],
1149 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_FORMAT_ERROR_DROP_CNT],
1150 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_ICV_ERROR_DROP_CNT],
1151 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_KEY_ERROR_DROP_CNT],
1152 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_TKIP_ERROR_DROP_CNT],
1153 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_MIC_ERROR_DROP_CNT],
1154 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_BIP_ERROR_DROP_CNT],
1155 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_FCSERR_CNT],
1156 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_FIFOFULL_CNT],
1157 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_RX_PFDROP_CNT]));
1158
1159 DBGLOG(SW4, INFO, ("RX1\n" \
1160 "%08x %08x %08x %08x\n" \
1161 "%08x %08x %08x %08x\n",
1162 (UINT_32)RX_GET_CNT(prRxCtrl, RX_MPDU_TOTAL_COUNT),
1163 (UINT_32)RX_GET_CNT(prRxCtrl, RX_DATA_INDICATION_COUNT),
1164 (UINT_32)RX_GET_CNT(prRxCtrl, RX_DATA_RETURNED_COUNT),
1165 (UINT_32)RX_GET_CNT(prRxCtrl, RX_DATA_RETAINED_COUNT),
1166 (UINT_32)RX_GET_CNT(prRxCtrl, RX_DROP_TOTAL_COUNT),
1167 (UINT_32)RX_GET_CNT(prRxCtrl, RX_TYPE_ERR_DROP_COUNT),
1168 (UINT_32)RX_GET_CNT(prRxCtrl, RX_CLASS_ERR_DROP_COUNT),
1169 (UINT_32)RX_GET_CNT(prRxCtrl, RX_DST_NULL_DROP_COUNT)));
1170
1171 DBGLOG(SW4, INFO, ("PWR\n" \
1172 "%08x %08x %08x %08x\n" \
1173 "%08x %08x %08x %08x\n",
1174 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_PS_POLL_CNT],
1175 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_TRIGGER_NULL_CNT],
1176 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_BCN_IND_CNT],
1177 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_BCN_TIMEOUT_CNT],
1178 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_PM_STATE0],
1179 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_PM_STATE1],
1180 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_CUR_PS_PROF0],
1181 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_PWR_CUR_PS_PROF1]));
1182
1183 DBGLOG(SW4, INFO, ("ARM\n" \
1184 "%08x %08x %08x %08x\n" \
1185 "%08x %08x\n",
1186 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_AR_STA0_RATE],
1187 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_AR_STA0_BWGI],
1188 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_AR_STA0_RX_RATE_RCPI],
1189 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_ROAMING_ENABLE],
1190 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_ROAMING_ROAM_CNT],
1191 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_ROAMING_INT_CNT]));
1192
1193 DBGLOG(SW4, INFO, ("BB\n" \
1194 "%08x %08x %08x %08x\n" \
1195 "%08x %08x %08x %08x\n",
1196 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_RX_MDRDY_CNT],
1197 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_RX_FCSERR_CNT],
1198 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_CCK_PD_CNT],
1199 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_OFDM_PD_CNT],
1200 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_CCK_SFDERR_CNT],
1201 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_CCK_SIGERR_CNT],
1202 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_OFDM_TAGERR_CNT],
1203 prCmdSwCtrl->u4DebugCnt[SWCR_DBG_ALL_BB_OFDM_SIGERR_CNT]));
1204
1205 }
1206 }
1207
1208 // start the next check
1209 if (g_u4SwcrDebugCheckTimeout) {
1210 cnmTimerStartTimer(prAdapter, &g_rSwcrDebugTimer, g_u4SwcrDebugCheckTimeout * MSEC_PER_SEC);
1211 }
1212}
1213
1214VOID swCrDebugCheckTimeout(
1215 IN P_ADAPTER_T prAdapter,
1216 ULONG ulParam)
1217{
1218 CMD_SW_DBG_CTRL_T rCmdSwCtrl;
1219 WLAN_STATUS rStatus;
1220
1221 rCmdSwCtrl.u4Id = (0xb000<<16) + g_ucSwcrDebugCheckType;
1222 rCmdSwCtrl.u4Data = 0;
1223 rStatus = wlanSendSetQueryCmd (
1224 prAdapter, /* prAdapter */
1225 CMD_ID_SW_DBG_CTRL, /* ucCID */
1226 FALSE, /* fgSetQuery */
1227 TRUE, /* fgNeedResp */
1228 FALSE, /* fgIsOid */
1229 swCrDebugQuery, /* pfCmdDoneHandler */
1230 swCrDebugQueryTimeout, /* pfCmdTimeoutHandler */
1231 sizeof(CMD_SW_DBG_CTRL_T), /* u4SetQueryInfoLen */
1232 (PUINT_8)&rCmdSwCtrl, /* pucInfoBuffer */
1233 NULL, /* pvSetQueryBuffer */
1234 0 /* u4SetQueryBufferLen */
1235 );
1236
1237 ASSERT(rStatus == WLAN_STATUS_PENDING);
1238
1239 return;
1240}
1241
1242VOID swCrDebugQuery(
1243 IN P_ADAPTER_T prAdapter,
1244 IN P_CMD_INFO_T prCmdInfo,
1245 IN PUINT_8 pucEventBuf
1246 )
1247{
1248 ASSERT(prAdapter);
1249
1250 swCrDebugCheck(prAdapter, (P_CMD_SW_DBG_CTRL_T)(pucEventBuf));
1251}
1252
1253VOID swCrDebugQueryTimeout(
1254 IN P_ADAPTER_T prAdapter,
1255 IN P_CMD_INFO_T prCmdInfo)
1256{
1257 ASSERT(prAdapter);
1258
1259 swCrDebugCheck(prAdapter, NULL);
1260}
1261
1262#endif /* CFG_SUPPORT_SWCR */
1263
1264
kernel source for telekom puls (alcatel/mediatek)