1 /*
2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 *
20 * File: power.c
21 *
22 * Purpose: Handles 802.11 power management functions
23 *
24 * Author: Lyndon Chen
25 *
26 * Date: July 17, 2002
27 *
28 * Functions:
29 * PSvEnablePowerSaving - Enable Power Saving Mode
30 * PSvDiasblePowerSaving - Disable Power Saving Mode
31 * PSbConsiderPowerDown - Decide if we can Power Down
32 * PSvSendPSPOLL - Send PS-POLL packet
33 * PSbSendNullPacket - Send Null packet
34 * PSbIsNextTBTTWakeUp - Decide if we need to wake up at next Beacon
35 *
36 * Revision History:
37 *
38 */
39
40 #include "mac.h"
41 #include "device.h"
42 #include "power.h"
43 #include "card.h"
44
45 /*--------------------- Static Definitions -------------------------*/
46
47 /*--------------------- Static Classes ----------------------------*/
48
49 /*--------------------- Static Functions --------------------------*/
50
51 /*--------------------- Export Variables --------------------------*/
52
53 /*--------------------- Export Functions --------------------------*/
54
55 /*+
56 *
57 * Routine Description:
58 * Enable hw power saving functions
59 *
60 * Return Value:
61 * None.
62 *
63 -*/
64
65 void
PSvEnablePowerSaving(void * hDeviceContext,unsigned short wListenInterval)66 PSvEnablePowerSaving(
67 void *hDeviceContext,
68 unsigned short wListenInterval
69 )
70 {
71 struct vnt_private *pDevice = hDeviceContext;
72 u16 wAID = pDevice->current_aid | BIT(14) | BIT(15);
73
74 /* set period of power up before TBTT */
75 VNSvOutPortW(pDevice->PortOffset + MAC_REG_PWBT, C_PWBT);
76 if (pDevice->op_mode != NL80211_IFTYPE_ADHOC) {
77 /* set AID */
78 VNSvOutPortW(pDevice->PortOffset + MAC_REG_AIDATIM, wAID);
79 } else {
80 /* set ATIM Window */
81 #if 0 /* TODO atim window */
82 MACvWriteATIMW(pDevice->PortOffset, pMgmt->wCurrATIMWindow);
83 #endif
84 }
85 /* Set AutoSleep */
86 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
87 /* Set HWUTSF */
88 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
89
90 if (wListenInterval >= 2) {
91 /* clear always listen beacon */
92 MACvRegBitsOff(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
93 /* first time set listen next beacon */
94 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_LNBCN);
95 } else {
96 /* always listen beacon */
97 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
98 }
99
100 /* enable power saving hw function */
101 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_PSEN);
102 pDevice->bEnablePSMode = true;
103
104 pDevice->bPWBitOn = true;
105 pr_debug("PS:Power Saving Mode Enable...\n");
106 }
107
108 /*+
109 *
110 * Routine Description:
111 * Disable hw power saving functions
112 *
113 * Return Value:
114 * None.
115 *
116 -*/
117
118 void
PSvDisablePowerSaving(void * hDeviceContext)119 PSvDisablePowerSaving(
120 void *hDeviceContext
121 )
122 {
123 struct vnt_private *pDevice = hDeviceContext;
124
125 /* disable power saving hw function */
126 MACbPSWakeup(pDevice->PortOffset);
127 /* clear AutoSleep */
128 MACvRegBitsOff(pDevice->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
129 /* clear HWUTSF */
130 MACvRegBitsOff(pDevice->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
131 /* set always listen beacon */
132 MACvRegBitsOn(pDevice->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
133
134 pDevice->bEnablePSMode = false;
135
136 pDevice->bPWBitOn = false;
137 }
138
139
140 /*+
141 *
142 * Routine Description:
143 * Check if Next TBTT must wake up
144 *
145 * Return Value:
146 * None.
147 *
148 -*/
149
150 bool
PSbIsNextTBTTWakeUp(void * hDeviceContext)151 PSbIsNextTBTTWakeUp(
152 void *hDeviceContext
153 )
154 {
155 struct vnt_private *pDevice = hDeviceContext;
156 struct ieee80211_hw *hw = pDevice->hw;
157 struct ieee80211_conf *conf = &hw->conf;
158 bool bWakeUp = false;
159
160 if (conf->listen_interval > 1) {
161 if (!pDevice->wake_up_count)
162 pDevice->wake_up_count = conf->listen_interval;
163
164 --pDevice->wake_up_count;
165
166 if (pDevice->wake_up_count == 1) {
167 /* Turn on wake up to listen next beacon */
168 MACvRegBitsOn(pDevice->PortOffset,
169 MAC_REG_PSCTL, PSCTL_LNBCN);
170 bWakeUp = true;
171 }
172 }
173
174 return bWakeUp;
175 }
176