1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
|
#include "precomp.h"
#include "gl_kal.h"
struct COMMAND {
UINT_8 ucCID;
BOOLEAN fgSetQuery;
BOOLEAN fgNeedResp;
UINT_8 ucCmdSeqNum;
};
struct SECURITY_FRAME {
UINT_16 u2EthType;
UINT_16 u2Reserved;
};
struct MGMT_FRAME {
UINT_16 u2FrameCtl;
UINT_16 u2DurationID;
};
struct TC_RES_RELEASE_ENTRY {
UINT_64 u8RelaseTime;
UINT_32 u4RelCID;
UINT_8 ucTc4RelCnt;
UINT_8 ucAvailableTc4;
};
struct CMD_TRACE_ENTRY {
UINT_64 u8TxTime;
COMMAND_TYPE eCmdType;
union {
struct COMMAND rCmd;
struct SECURITY_FRAME rSecFrame;
struct MGMT_FRAME rMgmtFrame;
} u;
};
typedef struct _COMMAND_ENTRY {
UINT_64 u8TxTime;
UINT_64 u8ReadFwTime;
UINT_32 u4ReadFwValue;
UINT_32 u4RelCID;
UINT_16 u2Counter;
struct COMMAND rCmd;
} COMMAND_ENTRY, *P_COMMAND_ENTRY;
#define TC_RELEASE_TRACE_BUF_MAX_NUM 100
#define TXED_CMD_TRACE_BUF_MAX_NUM 100
#define TXED_COMMAND_BUF_MAX_NUM 10
static struct TC_RES_RELEASE_ENTRY *gprTcReleaseTraceBuffer;
static struct CMD_TRACE_ENTRY *gprCmdTraceEntry;
static P_COMMAND_ENTRY gprCommandEntry;
VOID wlanDebugInit(VOID)
{
/* debug for command/tc4 resource begin */
gprTcReleaseTraceBuffer =
kalMemAlloc(TC_RELEASE_TRACE_BUF_MAX_NUM * sizeof(struct TC_RES_RELEASE_ENTRY), PHY_MEM_TYPE);
kalMemZero(gprTcReleaseTraceBuffer, TC_RELEASE_TRACE_BUF_MAX_NUM * sizeof(struct TC_RES_RELEASE_ENTRY));
gprCmdTraceEntry = kalMemAlloc(TXED_CMD_TRACE_BUF_MAX_NUM * sizeof(struct CMD_TRACE_ENTRY), PHY_MEM_TYPE);
kalMemZero(gprCmdTraceEntry, TXED_CMD_TRACE_BUF_MAX_NUM * sizeof(struct CMD_TRACE_ENTRY));
gprCommandEntry = kalMemAlloc(TXED_COMMAND_BUF_MAX_NUM * sizeof(COMMAND_ENTRY), PHY_MEM_TYPE);
kalMemZero(gprCommandEntry, TXED_COMMAND_BUF_MAX_NUM * sizeof(COMMAND_ENTRY));
/* debug for command/tc4 resource end */
}
VOID wlanDebugUninit(VOID)
{
/* debug for command/tc4 resource begin */
kalMemFree(gprTcReleaseTraceBuffer, PHY_MEM_TYPE,
TC_RELEASE_TRACE_BUF_MAX_NUM * sizeof(struct TC_RES_RELEASE_ENTRY));
kalMemFree(gprCmdTraceEntry, PHY_MEM_TYPE, TXED_CMD_TRACE_BUF_MAX_NUM * sizeof(struct CMD_TRACE_ENTRY));
kalMemFree(gprCommandEntry, PHY_MEM_TYPE, TXED_COMMAND_BUF_MAX_NUM * sizeof(COMMAND_ENTRY));
/* debug for command/tc4 resource end */
}
VOID wlanReadFwStatus(P_ADAPTER_T prAdapter)
{
static UINT_16 u2CurEntryCmd;
P_COMMAND_ENTRY prCurCommand = &gprCommandEntry[u2CurEntryCmd];
prCurCommand->u8ReadFwTime = sched_clock();
HAL_MCR_RD(prAdapter, MCR_D2HRM2R, &prCurCommand->u4ReadFwValue);
u2CurEntryCmd++;
if (u2CurEntryCmd == TXED_COMMAND_BUF_MAX_NUM)
u2CurEntryCmd = 0;
}
VOID wlanTraceTxCmd(P_ADAPTER_T prAdapter, P_CMD_INFO_T prCmd)
{
static UINT_16 u2CurEntry;
static UINT_16 u2CurEntryCmd;
struct CMD_TRACE_ENTRY *prCurCmd = &gprCmdTraceEntry[u2CurEntry];
P_COMMAND_ENTRY prCurCommand = &gprCommandEntry[u2CurEntryCmd];
prCurCmd->u8TxTime = sched_clock();
prCurCommand->u8TxTime = prCurCmd->u8TxTime;
prCurCmd->eCmdType = prCmd->eCmdType;
if (prCmd->eCmdType == COMMAND_TYPE_MANAGEMENT_FRAME) {
P_WLAN_MAC_MGMT_HEADER_T prMgmt = (P_WLAN_MAC_MGMT_HEADER_T)((P_MSDU_INFO_T)prCmd->prPacket)->prPacket;
prCurCmd->u.rMgmtFrame.u2FrameCtl = prMgmt->u2FrameCtrl;
prCurCmd->u.rMgmtFrame.u2DurationID = prMgmt->u2Duration;
} else if (prCmd->eCmdType == COMMAND_TYPE_SECURITY_FRAME) {
PUINT_8 pucPkt = (PUINT_8)((struct sk_buff *)prCmd->prPacket)->data;
prCurCmd->u.rSecFrame.u2EthType =
(pucPkt[ETH_TYPE_LEN_OFFSET] << 8) | (pucPkt[ETH_TYPE_LEN_OFFSET + 1]);
} else {
prCurCmd->u.rCmd.ucCID = prCmd->ucCID;
prCurCmd->u.rCmd.ucCmdSeqNum = prCmd->ucCmdSeqNum;
prCurCmd->u.rCmd.fgNeedResp = prCmd->fgNeedResp;
prCurCmd->u.rCmd.fgSetQuery = prCmd->fgSetQuery;
prCurCommand->rCmd.ucCID = prCmd->ucCID;
prCurCommand->rCmd.ucCmdSeqNum = prCmd->ucCmdSeqNum;
prCurCommand->rCmd.fgNeedResp = prCmd->fgNeedResp;
prCurCommand->rCmd.fgSetQuery = prCmd->fgSetQuery;
prCurCommand->u2Counter = u2CurEntryCmd;
u2CurEntryCmd++;
if (u2CurEntryCmd == TXED_COMMAND_BUF_MAX_NUM)
u2CurEntryCmd = 0;
HAL_MCR_RD(prAdapter, MCR_D2HRM2R, &prCurCommand->u4RelCID);
}
u2CurEntry++;
if (u2CurEntry == TC_RELEASE_TRACE_BUF_MAX_NUM)
u2CurEntry = 0;
}
VOID wlanTraceReleaseTcRes(P_ADAPTER_T prAdapter, PUINT_8 aucTxRlsCnt, UINT_8 ucAvailable)
{
static UINT_16 u2CurEntry;
struct TC_RES_RELEASE_ENTRY *prCurBuf = &gprTcReleaseTraceBuffer[u2CurEntry];
HAL_MCR_RD(prAdapter, MCR_D2HRM2R, &prCurBuf->u4RelCID);
prCurBuf->u8RelaseTime = sched_clock();
prCurBuf->ucTc4RelCnt = aucTxRlsCnt[TC4_INDEX];
prCurBuf->ucAvailableTc4 = ucAvailable;
u2CurEntry++;
if (u2CurEntry == TXED_CMD_TRACE_BUF_MAX_NUM)
u2CurEntry = 0;
}
VOID wlanDumpTcResAndTxedCmd(PUINT_8 pucBuf, UINT_32 maxLen)
{
UINT_16 i = 0;
struct CMD_TRACE_ENTRY *prCmd = gprCmdTraceEntry;
struct TC_RES_RELEASE_ENTRY *prTcRel = gprTcReleaseTraceBuffer;
if (pucBuf) {
int bufLen = 0;
for (; i < TXED_CMD_TRACE_BUF_MAX_NUM/2; i++) {
bufLen = snprintf(pucBuf, maxLen,
"%d: Time %llu, Type %d, Content %08x; %d: Time %llu, Type %d, Content %08x\n",
i*2, prCmd[i*2].u8TxTime, prCmd[i*2].eCmdType, *(PUINT_32)(&prCmd[i*2].u.rCmd.ucCID),
i*2+1, prCmd[i*2+1].u8TxTime, prCmd[i*2+1].eCmdType,
*(PUINT_32)(&prCmd[i*2+1].u.rCmd.ucCID));
if (bufLen <= 0)
break;
pucBuf += bufLen;
maxLen -= bufLen;
}
for (i = 0; i < TC_RELEASE_TRACE_BUF_MAX_NUM/2; i++) {
bufLen = snprintf(pucBuf, maxLen,
"%d: Time %llu, Tc4Cnt %d, Free %d, CID %08x; %d: Time %llu, Tc4Cnt %d, Free %d CID %08x\n",
i*2, prTcRel[i*2].u8RelaseTime, prTcRel[i*2].ucTc4RelCnt, prTcRel[i*2].ucAvailableTc4,
prTcRel[i*2].u4RelCID,
i*2+1, prTcRel[i*2+1].u8RelaseTime, prTcRel[i*2+1].ucTc4RelCnt,
prTcRel[i*2+1].ucAvailableTc4, prTcRel[i*2+1].u4RelCID);
if (bufLen <= 0)
break;
pucBuf += bufLen;
maxLen -= bufLen;
}
return;
}
for (; i < TXED_CMD_TRACE_BUF_MAX_NUM/4; i++) {
LOG_FUNC("%d: Time %llu, Type %d, Content %08x; %d: Time %llu, Type %d, Content %08x; ",
i*4, prCmd[i*4].u8TxTime, prCmd[i*4].eCmdType,
*(PUINT_32)(&prCmd[i*4].u.rCmd.ucCID),
i*4+1, prCmd[i*4+1].u8TxTime, prCmd[i*4+1].eCmdType,
*(PUINT_32)(&prCmd[i*4+1].u.rCmd.ucCID));
LOG_FUNC("%d: Time %llu, Type %d, Content %08x; %d: Time %llu, Type %d, Content %08x\n",
i*4+2, prCmd[i*4+2].u8TxTime, prCmd[i*4+2].eCmdType,
*(PUINT_32)(&prCmd[i*4+2].u.rCmd.ucCID),
i*4+3, prCmd[i*4+3].u8TxTime, prCmd[i*4+3].eCmdType,
*(PUINT_32)(&prCmd[i*4+3].u.rCmd.ucCID));
}
for (i = 0; i < TC_RELEASE_TRACE_BUF_MAX_NUM/4; i++) {
LOG_FUNC(
"%d: Time %llu, Tc4Cnt %d, Free %d, CID %08x; %d: Time %llu, Tc4Cnt %d, Free %d, CID %08x;",
i*4, prTcRel[i*4].u8RelaseTime, prTcRel[i*4].ucTc4RelCnt,
prTcRel[i*4].ucAvailableTc4, prTcRel[i*4].u4RelCID,
i*4+1, prTcRel[i*4+1].u8RelaseTime, prTcRel[i*4+1].ucTc4RelCnt,
prTcRel[i*4+1].ucAvailableTc4, prTcRel[i*4+1].u4RelCID);
LOG_FUNC(
" %d: Time %llu, Tc4Cnt %d, Free %d, CID %08x; %d: Time %llu, Tc4Cnt %d, Free %d, CID %08x\n",
i*4+2, prTcRel[i*4+2].u8RelaseTime, prTcRel[i*4+2].ucTc4RelCnt,
prTcRel[i*4+2].ucAvailableTc4, prTcRel[i*4+2].u4RelCID,
i*4+3, prTcRel[i*4+3].u8RelaseTime, prTcRel[i*4+3].ucTc4RelCnt,
prTcRel[i*4+3].ucAvailableTc4, prTcRel[i*4+3].u4RelCID);
}
}
VOID wlanDumpCommandFwStatus(VOID)
{
UINT_16 i = 0;
P_COMMAND_ENTRY prCmd = gprCommandEntry;
LOG_FUNC("Start\n");
for (; i < TXED_COMMAND_BUF_MAX_NUM; i++) {
LOG_FUNC("%d: Time %llu, Content %08x, Count %x, RelCID %08x, ReadFwValue %08x, ReadFwTime %llu\n",
i, prCmd[i].u8TxTime, *(PUINT_32)(&prCmd[i].rCmd.ucCID),
prCmd[i].u2Counter, prCmd[i].u4RelCID,
prCmd[i].u4ReadFwValue, prCmd[i].u8ReadFwTime);
}
}
|
