1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
4 * All rights reserved.
5 *
6 * Purpose: Handles 802.11 power management functions
7 *
8 * Author: Lyndon Chen
9 *
10 * Date: July 17, 2002
11 *
12 * Functions:
13 *      vnt_enable_power_saving - Enable Power Saving Mode
14 *      PSvDiasblePowerSaving - Disable Power Saving Mode
15 *      vnt_next_tbtt_wakeup - Decide if we need to wake up at next Beacon
16 *
17 * Revision History:
18 *
19 */
20
21#include "mac.h"
22#include "device.h"
23#include "power.h"
24#include "wcmd.h"
25#include "rxtx.h"
26#include "card.h"
27#include "usbpipe.h"
28
29/*
30 *
31 * Routine Description:
32 * Enable hw power saving functions
33 *
34 * Return Value:
35 *    None.
36 *
37 */
38
39void vnt_enable_power_saving(struct vnt_private *priv, u16 listen_interval)
40{
41	u16 aid = priv->current_aid | BIT(14) | BIT(15);
42
43	/* set period of power up before TBTT */
44	vnt_mac_write_word(priv, MAC_REG_PWBT, C_PWBT);
45
46	if (priv->op_mode != NL80211_IFTYPE_ADHOC)
47		/* set AID */
48		vnt_mac_write_word(priv, MAC_REG_AIDATIM, aid);
49
50	/* Warren:06-18-2004,the sequence must follow
51	 * PSEN->AUTOSLEEP->GO2DOZE
52	 */
53	/* enable power saving hw function */
54	vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_PSEN);
55
56	/* Set AutoSleep */
57	vnt_mac_reg_bits_on(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
58
59	/* Warren:MUST turn on this once before turn on AUTOSLEEP ,or the
60	 * AUTOSLEEP doesn't work
61	 */
62	vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_GO2DOZE);
63
64	/* always listen beacon */
65	vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
66
67	dev_dbg(&priv->usb->dev,  "PS:Power Saving Mode Enable...\n");
68}
69
70int vnt_disable_power_saving(struct vnt_private *priv)
71{
72	int ret;
73
74	/* disable power saving hw function */
75	ret = vnt_control_out(priv, MESSAGE_TYPE_DISABLE_PS, 0,
76			      0, 0, NULL);
77	if (ret)
78		return ret;
79
80	/* clear AutoSleep */
81	vnt_mac_reg_bits_off(priv, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);
82
83	/* set always listen beacon */
84	vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_ALBCN);
85
86	return 0;
87}
88
89/*
90 *
91 * Routine Description:
92 * Check if Next TBTT must wake up
93 *
94 * Return Value:
95 *    None.
96 *
97 */
98
99int vnt_next_tbtt_wakeup(struct vnt_private *priv)
100{
101	struct ieee80211_hw *hw = priv->hw;
102	struct ieee80211_conf *conf = &hw->conf;
103	int wake_up = false;
104
105	if (conf->listen_interval > 1) {
106		/* Turn on wake up to listen next beacon */
107		vnt_mac_reg_bits_on(priv, MAC_REG_PSCTL, PSCTL_LNBCN);
108		wake_up = true;
109	}
110
111	return wake_up;
112}
113