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#include "ttype.h"
41#include "mac.h"
42#include "device.h"
43#include "wmgr.h"
44#include "power.h"
45#include "wcmd.h"
46#include "rxtx.h"
47#include "card.h"
48
49
50
51
52
53
54
55
56
57static int msglevel =MSG_LEVEL_INFO;
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77VOID
78PSvEnablePowerSaving(
79 IN HANDLE hDeviceContext,
80 IN WORD wListenInterval
81 )
82{
83 PSDevice pDevice = (PSDevice)hDeviceContext;
84 PSMgmtObject pMgmt = pDevice->pMgmt;
85 WORD wAID = pMgmt->wCurrAID | BIT14 | BIT15;
86
87
88 VNSvOutPortW(pDevice->PortOffset + MAC_REG_PWBT, C_PWBT);
89 if (pDevice->eOPMode != OP_MODE_ADHOC) {
90
91 VNSvOutPortW(pDevice->PortOffset + MAC_REG_AIDATIM, wAID);
92 } else {
93
94 MACvWriteATIMW(pDevice->PortOffset, pMgmt->wCurrATIMWindow);
95 }
96
97 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
98
99 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
100
101 if (wListenInterval >= 2) {
102
103 MACvRegBitsOff(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
104
105
106 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_LNBCN);
107 pMgmt->wCountToWakeUp = wListenInterval;
108 }
109 else {
110
111 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
112
113 pMgmt->wCountToWakeUp = 0;
114 }
115
116
117 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_PSEN);
118 pDevice->bEnablePSMode = TRUE;
119
120 if (pDevice->eOPMode == OP_MODE_ADHOC) {
121
122 }
123
124 else if (pDevice->eOPMode == OP_MODE_INFRASTRUCTURE) {
125 PSbSendNullPacket(pDevice);
126 }
127 pDevice->bPWBitOn = TRUE;
128 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "PS:Power Saving Mode Enable... \n");
129 return;
130}
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147VOID
148PSvDisablePowerSaving(
149 IN HANDLE hDeviceContext
150 )
151{
152 PSDevice pDevice = (PSDevice)hDeviceContext;
153
154
155
156 MACbPSWakeup(pDevice->PortOffset);
157
158 MACvRegBitsOff(pDevice->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
159
160 MACvRegBitsOff(pDevice->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
161
162 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
163
164 pDevice->bEnablePSMode = FALSE;
165
166 if (pDevice->eOPMode == OP_MODE_INFRASTRUCTURE) {
167 PSbSendNullPacket(pDevice);
168 }
169 pDevice->bPWBitOn = FALSE;
170 return;
171}
172
173
174
175
176
177
178
179
180
181
182
183
184
185BOOL
186PSbConsiderPowerDown(
187 IN HANDLE hDeviceContext,
188 IN BOOL bCheckRxDMA,
189 IN BOOL bCheckCountToWakeUp
190 )
191{
192 PSDevice pDevice = (PSDevice)hDeviceContext;
193 PSMgmtObject pMgmt = pDevice->pMgmt;
194 UINT uIdx;
195
196
197 if (MACbIsRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_PS))
198 return TRUE;
199
200 if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
201
202 if (pMgmt->bInTIMWake)
203 return FALSE;
204 }
205
206
207 if (pDevice->bCmdRunning)
208 return FALSE;
209
210
211 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_PSEN);
212
213
214 for (uIdx = 0; uIdx < TYPE_MAXTD; uIdx ++) {
215 if (pDevice->iTDUsed[uIdx] != 0)
216 return FALSE;
217 }
218
219
220 if (bCheckRxDMA &&
221 ((pDevice->dwIsr& ISR_RXDMA0) != 0) &&
222 ((pDevice->dwIsr & ISR_RXDMA1) != 0)){
223 return FALSE;
224 };
225
226 if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
227 if (bCheckCountToWakeUp &&
228 (pMgmt->wCountToWakeUp == 0 || pMgmt->wCountToWakeUp == 1)) {
229 return FALSE;
230 }
231 }
232
233
234 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_GO2DOZE);
235 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Go to Doze ZZZZZZZZZZZZZZZ\n");
236 return TRUE;
237}
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253VOID
254PSvSendPSPOLL(
255 IN HANDLE hDeviceContext
256 )
257{
258 PSDevice pDevice = (PSDevice)hDeviceContext;
259 PSMgmtObject pMgmt = pDevice->pMgmt;
260 PSTxMgmtPacket pTxPacket = NULL;
261
262
263 memset(pMgmt->pbyPSPacketPool, 0, sizeof(STxMgmtPacket) + WLAN_HDR_ADDR2_LEN);
264 pTxPacket = (PSTxMgmtPacket)pMgmt->pbyPSPacketPool;
265 pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));
266 pTxPacket->p80211Header->sA2.wFrameCtl = cpu_to_le16(
267 (
268 WLAN_SET_FC_FTYPE(WLAN_TYPE_CTL) |
269 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PSPOLL) |
270 WLAN_SET_FC_PWRMGT(0)
271 ));
272 pTxPacket->p80211Header->sA2.wDurationID = pMgmt->wCurrAID | BIT14 | BIT15;
273 memcpy(pTxPacket->p80211Header->sA2.abyAddr1, pMgmt->abyCurrBSSID, WLAN_ADDR_LEN);
274 memcpy(pTxPacket->p80211Header->sA2.abyAddr2, pMgmt->abyMACAddr, WLAN_ADDR_LEN);
275 pTxPacket->cbMPDULen = WLAN_HDR_ADDR2_LEN;
276 pTxPacket->cbPayloadLen = 0;
277
278 if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
279 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send PS-Poll packet failed..\n");
280 }
281 else {
282
283 };
284
285 return;
286}
287
288
289
290
291
292
293
294
295
296
297
298
299BOOL
300PSbSendNullPacket(
301 IN HANDLE hDeviceContext
302 )
303{
304 PSDevice pDevice = (PSDevice)hDeviceContext;
305 PSTxMgmtPacket pTxPacket = NULL;
306 PSMgmtObject pMgmt = pDevice->pMgmt;
307 UINT uIdx;
308
309
310 if (pDevice->bLinkPass == FALSE) {
311 return FALSE;
312 }
313 #ifdef TxInSleep
314 if ((pDevice->bEnablePSMode == FALSE) &&
315 (pDevice->fTxDataInSleep == FALSE)){
316 return FALSE;
317 }
318#else
319 if (pDevice->bEnablePSMode == FALSE) {
320 return FALSE;
321 }
322#endif
323 if (pDevice->bEnablePSMode) {
324 for (uIdx = 0; uIdx < TYPE_MAXTD; uIdx ++) {
325 if (pDevice->iTDUsed[uIdx] != 0)
326 return FALSE;
327 }
328 }
329
330 memset(pMgmt->pbyPSPacketPool, 0, sizeof(STxMgmtPacket) + WLAN_NULLDATA_FR_MAXLEN);
331 pTxPacket = (PSTxMgmtPacket)pMgmt->pbyPSPacketPool;
332 pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));
333
334 if (pDevice->bEnablePSMode) {
335
336 pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(
337 (
338 WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) |
339 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_NULL) |
340 WLAN_SET_FC_PWRMGT(1)
341 ));
342 }
343 else {
344 pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(
345 (
346 WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) |
347 WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_NULL) |
348 WLAN_SET_FC_PWRMGT(0)
349 ));
350 }
351
352 if(pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
353 pTxPacket->p80211Header->sA3.wFrameCtl |= cpu_to_le16((WORD)WLAN_SET_FC_TODS(1));
354 }
355
356 memcpy(pTxPacket->p80211Header->sA3.abyAddr1, pMgmt->abyCurrBSSID, WLAN_ADDR_LEN);
357 memcpy(pTxPacket->p80211Header->sA3.abyAddr2, pMgmt->abyMACAddr, WLAN_ADDR_LEN);
358 memcpy(pTxPacket->p80211Header->sA3.abyAddr3, pMgmt->abyCurrBSSID, WLAN_BSSID_LEN);
359 pTxPacket->cbMPDULen = WLAN_HDR_ADDR3_LEN;
360 pTxPacket->cbPayloadLen = 0;
361
362 if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
363 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send Null Packet failed !\n");
364 return FALSE;
365 }
366 else {
367
368
369 }
370
371
372 return TRUE ;
373}
374
375
376
377
378
379
380
381
382
383
384
385BOOL
386PSbIsNextTBTTWakeUp(
387 IN HANDLE hDeviceContext
388 )
389{
390
391 PSDevice pDevice = (PSDevice)hDeviceContext;
392 PSMgmtObject pMgmt = pDevice->pMgmt;
393 BOOL bWakeUp = FALSE;
394
395 if (pMgmt->wListenInterval >= 2) {
396 if (pMgmt->wCountToWakeUp == 0) {
397 pMgmt->wCountToWakeUp = pMgmt->wListenInterval;
398 }
399
400 pMgmt->wCountToWakeUp --;
401
402 if (pMgmt->wCountToWakeUp == 1) {
403
404 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_LNBCN);
405 bWakeUp = TRUE;
406 }
407
408 }
409
410 return bWakeUp;
411}
412
413