• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
4  * All rights reserved.
5  *
6  * File: power.c
7  *
8  * Purpose: Handles 802.11 power management  functions
9  *
10  * Author: Lyndon Chen
11  *
12  * Date: July 17, 2002
13  *
14  * Functions:
15  *      PSvEnablePowerSaving - Enable Power Saving Mode
16  *      PSvDiasblePowerSaving - Disable Power Saving Mode
17  *      PSbConsiderPowerDown - Decide if we can Power Down
18  *      PSvSendPSPOLL - Send PS-POLL packet
19  *      PSbSendNullPacket - Send Null packet
20  *      PSbIsNextTBTTWakeUp - Decide if we need to wake up at next Beacon
21  *
22  * Revision History:
23  *
24  */
25 
26 #include "mac.h"
27 #include "device.h"
28 #include "power.h"
29 #include "card.h"
30 
31 /*---------------------  Static Definitions -------------------------*/
32 
33 /*---------------------  Static Classes  ----------------------------*/
34 
35 /*---------------------  Static Functions  --------------------------*/
36 
37 /*---------------------  Export Variables  --------------------------*/
38 
39 /*---------------------  Export Functions  --------------------------*/
40 
41 /*
42  *
43  * Routine Description:
44  * Enable hw power saving functions
45  *
46  * Return Value:
47  *    None.
48  *
49  */
50 
PSvEnablePowerSaving(struct vnt_private * priv,unsigned short wListenInterval)51 void PSvEnablePowerSaving(struct vnt_private *priv,
52 			  unsigned short wListenInterval)
53 {
54 	u16 wAID = priv->current_aid | BIT(14) | BIT(15);
55 
56 	/* set period of power up before TBTT */
57 	VNSvOutPortW(priv->PortOffset + MAC_REG_PWBT, C_PWBT);
58 	if (priv->op_mode != NL80211_IFTYPE_ADHOC) {
59 		/* set AID */
60 		VNSvOutPortW(priv->PortOffset + MAC_REG_AIDATIM, wAID);
61 	}
62 
63 	/* Set AutoSleep */
64 	MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
65 
66 	/* Set HWUTSF */
67 	MACvRegBitsOn(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
68 
69 	if (wListenInterval >= 2) {
70 		/* clear always listen beacon */
71 		MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
72 		/* first time set listen next beacon */
73 		MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_LNBCN);
74 	} else {
75 		/* always listen beacon */
76 		MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
77 	}
78 
79 	/* enable power saving hw function */
80 	MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_PSEN);
81 	priv->bEnablePSMode = true;
82 
83 	priv->bPWBitOn = true;
84 	pr_debug("PS:Power Saving Mode Enable...\n");
85 }
86 
87 /*
88  *
89  * Routine Description:
90  * Disable hw power saving functions
91  *
92  * Return Value:
93  *    None.
94  *
95  */
96 
PSvDisablePowerSaving(struct vnt_private * priv)97 void PSvDisablePowerSaving(struct vnt_private *priv)
98 {
99 	/* disable power saving hw function */
100 	MACbPSWakeup(priv);
101 
102 	/* clear AutoSleep */
103 	MACvRegBitsOff(priv->PortOffset, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
104 
105 	/* clear HWUTSF */
106 	MACvRegBitsOff(priv->PortOffset, MAC_REG_TFTCTL, TFTCTL_HWUTSF);
107 
108 	/* set always listen beacon */
109 	MACvRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_ALBCN);
110 
111 	priv->bEnablePSMode = false;
112 
113 	priv->bPWBitOn = false;
114 }
115 
116 /*
117  *
118  * Routine Description:
119  * Check if Next TBTT must wake up
120  *
121  * Return Value:
122  *    None.
123  *
124  */
125 
PSbIsNextTBTTWakeUp(struct vnt_private * priv)126 bool PSbIsNextTBTTWakeUp(struct vnt_private *priv)
127 {
128 	struct ieee80211_hw *hw = priv->hw;
129 	struct ieee80211_conf *conf = &hw->conf;
130 	bool wake_up = false;
131 
132 	if (conf->listen_interval > 1) {
133 		if (!priv->wake_up_count)
134 			priv->wake_up_count = conf->listen_interval;
135 
136 		--priv->wake_up_count;
137 
138 		if (priv->wake_up_count == 1) {
139 			/* Turn on wake up to listen next beacon */
140 			MACvRegBitsOn(priv->PortOffset,
141 				      MAC_REG_PSCTL, PSCTL_LNBCN);
142 			wake_up = true;
143 		}
144 	}
145 
146 	return wake_up;
147 }
148