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 *      vnt_enable_power_saving - Enable Power Saving Mode
30 *      PSvDiasblePowerSaving - Disable Power Saving Mode
31 *      vnt_next_tbtt_wakeup - Decide if we need to wake up at next Beacon
32 *
33 * Revision History:
34 *
35 */
36
37#include "mac.h"
38#include "device.h"
39#include "power.h"
40#include "wcmd.h"
41#include "rxtx.h"
42#include "card.h"
43#include "usbpipe.h"
44
45/*
46 *
47 * Routine Description:
48 * Enable hw power saving functions
49 *
50 * Return Value:
51 *    None.
52 *
53 */
54
55void vnt_enable_power_saving(struct vnt_private *priv, u16 listen_interval)
56{
57	u16 aid = priv->current_aid | BIT(14) | BIT(15);
58
59	/* set period of power up before TBTT */
60	vnt_mac_write_word(priv, MAC_REG_PWBT, C_PWBT);
61
62	if (priv->op_mode != NL80211_IFTYPE_ADHOC) {
63		/* set AID */
64		vnt_mac_write_word(priv, MAC_REG_AIDATIM, aid);
65	}
66
67	/* Warren:06-18-2004,the sequence must follow
68	 * PSEN->AUTOSLEEP->GO2DOZE
69	 */
70	/* enable power saving hw function */
71	vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_PSEN);
72
73	/* Set AutoSleep */
74	vnt_mac_reg_bits_on(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
75
76	/* Warren:MUST turn on this once before turn on AUTOSLEEP ,or the
77	 * AUTOSLEEP doesn't work
78	 */
79	vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_GO2DOZE);
80
81	if (listen_interval >= 2) {
82
83		/* clear always listen beacon */
84		vnt_mac_reg_bits_off(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
85
86		/* first time set listen next beacon */
87		vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_LNBCN);
88	} else {
89
90		/* always listen beacon */
91		vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
92	}
93
94	dev_dbg(&priv->usb->dev,  "PS:Power Saving Mode Enable...\n");
95}
96
97/*
98 *
99 * Routine Description:
100 * Disable hw power saving functions
101 *
102 * Return Value:
103 *    None.
104 *
105 */
106
107void vnt_disable_power_saving(struct vnt_private *priv)
108{
109
110	/* disable power saving hw function */
111	vnt_control_out(priv, MESSAGE_TYPE_DISABLE_PS, 0,
112						0, 0, NULL);
113
114	/* clear AutoSleep */
115	vnt_mac_reg_bits_off(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
116
117	/* set always listen beacon */
118	vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
119}
120
121/*
122 *
123 * Routine Description:
124 * Check if Next TBTT must wake up
125 *
126 * Return Value:
127 *    None.
128 *
129 */
130
131int vnt_next_tbtt_wakeup(struct vnt_private *priv)
132{
133	struct ieee80211_hw *hw = priv->hw;
134	struct ieee80211_conf *conf = &hw->conf;
135	int wake_up = false;
136
137	if (conf->listen_interval == 1) {
138		/* Turn on wake up to listen next beacon */
139		vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_LNBCN);
140		wake_up = true;
141	}
142
143	return wake_up;
144}
145