1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * This file is part of wl1251 |
4 | * |
5 | * Copyright (C) 2008 Nokia Corporation |
6 | */ |
7 | |
8 | #include "reg.h" |
9 | #include "ps.h" |
10 | #include "cmd.h" |
11 | #include "io.h" |
12 | |
13 | /* in ms */ |
14 | #define WL1251_WAKEUP_TIMEOUT 100 |
15 | |
16 | void wl1251_elp_work(struct work_struct *work) |
17 | { |
18 | struct delayed_work *dwork; |
19 | struct wl1251 *wl; |
20 | |
21 | dwork = to_delayed_work(work); |
22 | wl = container_of(dwork, struct wl1251, elp_work); |
23 | |
24 | wl1251_debug(DEBUG_PSM, "elp work" ); |
25 | |
26 | mutex_lock(&wl->mutex); |
27 | |
28 | if (wl->elp || wl->station_mode == STATION_ACTIVE_MODE) |
29 | goto out; |
30 | |
31 | wl1251_debug(DEBUG_PSM, "chip to elp" ); |
32 | wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_SLEEP); |
33 | wl->elp = true; |
34 | |
35 | out: |
36 | mutex_unlock(lock: &wl->mutex); |
37 | } |
38 | |
39 | #define ELP_ENTRY_DELAY 5 |
40 | |
41 | /* Routines to toggle sleep mode while in ELP */ |
42 | void wl1251_ps_elp_sleep(struct wl1251 *wl) |
43 | { |
44 | unsigned long delay; |
45 | |
46 | if (wl->station_mode != STATION_ACTIVE_MODE) { |
47 | delay = msecs_to_jiffies(ELP_ENTRY_DELAY); |
48 | ieee80211_queue_delayed_work(hw: wl->hw, dwork: &wl->elp_work, delay); |
49 | } |
50 | } |
51 | |
52 | int wl1251_ps_elp_wakeup(struct wl1251 *wl) |
53 | { |
54 | unsigned long timeout, start; |
55 | u32 elp_reg; |
56 | |
57 | cancel_delayed_work(dwork: &wl->elp_work); |
58 | |
59 | if (!wl->elp) |
60 | return 0; |
61 | |
62 | wl1251_debug(DEBUG_PSM, "waking up chip from elp" ); |
63 | |
64 | start = jiffies; |
65 | timeout = jiffies + msecs_to_jiffies(WL1251_WAKEUP_TIMEOUT); |
66 | |
67 | wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_WAKE_UP); |
68 | |
69 | elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR); |
70 | |
71 | /* |
72 | * FIXME: we should wait for irq from chip but, as a temporary |
73 | * solution to simplify locking, let's poll instead |
74 | */ |
75 | while (!(elp_reg & ELPCTRL_WLAN_READY)) { |
76 | if (time_after(jiffies, timeout)) { |
77 | wl1251_error("elp wakeup timeout" ); |
78 | return -ETIMEDOUT; |
79 | } |
80 | msleep(msecs: 1); |
81 | elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR); |
82 | } |
83 | |
84 | wl1251_debug(DEBUG_PSM, "wakeup time: %u ms" , |
85 | jiffies_to_msecs(jiffies - start)); |
86 | |
87 | wl->elp = false; |
88 | |
89 | return 0; |
90 | } |
91 | |
92 | int wl1251_ps_set_mode(struct wl1251 *wl, enum wl1251_station_mode mode) |
93 | { |
94 | int ret; |
95 | |
96 | switch (mode) { |
97 | case STATION_POWER_SAVE_MODE: |
98 | wl1251_debug(DEBUG_PSM, "entering psm" ); |
99 | |
100 | /* enable beacon filtering */ |
101 | ret = wl1251_acx_beacon_filter_opt(wl, enable_filter: true); |
102 | if (ret < 0) |
103 | return ret; |
104 | |
105 | ret = wl1251_acx_wake_up_conditions(wl, |
106 | wake_up_event: WAKE_UP_EVENT_DTIM_BITMAP, |
107 | listen_interval: wl->listen_int); |
108 | if (ret < 0) |
109 | return ret; |
110 | |
111 | ret = wl1251_acx_bet_enable(wl, mode: WL1251_ACX_BET_ENABLE, |
112 | WL1251_DEFAULT_BET_CONSECUTIVE); |
113 | if (ret < 0) |
114 | return ret; |
115 | |
116 | ret = wl1251_cmd_ps_mode(wl, ps_mode: CHIP_POWER_SAVE_MODE); |
117 | if (ret < 0) |
118 | return ret; |
119 | |
120 | ret = wl1251_acx_sleep_auth(wl, sleep_auth: WL1251_PSM_ELP); |
121 | if (ret < 0) |
122 | return ret; |
123 | break; |
124 | case STATION_IDLE: |
125 | wl1251_debug(DEBUG_PSM, "entering idle" ); |
126 | |
127 | ret = wl1251_acx_sleep_auth(wl, sleep_auth: WL1251_PSM_ELP); |
128 | if (ret < 0) |
129 | return ret; |
130 | |
131 | ret = wl1251_cmd_template_set(wl, cmd_id: CMD_DISCONNECT, NULL, buf_len: 0); |
132 | if (ret < 0) |
133 | return ret; |
134 | break; |
135 | case STATION_ACTIVE_MODE: |
136 | default: |
137 | wl1251_debug(DEBUG_PSM, "leaving psm" ); |
138 | |
139 | ret = wl1251_acx_sleep_auth(wl, sleep_auth: WL1251_PSM_CAM); |
140 | if (ret < 0) |
141 | return ret; |
142 | |
143 | /* disable BET */ |
144 | ret = wl1251_acx_bet_enable(wl, mode: WL1251_ACX_BET_DISABLE, |
145 | WL1251_DEFAULT_BET_CONSECUTIVE); |
146 | if (ret < 0) |
147 | return ret; |
148 | |
149 | /* disable beacon filtering */ |
150 | ret = wl1251_acx_beacon_filter_opt(wl, enable_filter: false); |
151 | if (ret < 0) |
152 | return ret; |
153 | |
154 | ret = wl1251_acx_wake_up_conditions(wl, |
155 | wake_up_event: WAKE_UP_EVENT_DTIM_BITMAP, |
156 | listen_interval: wl->listen_int); |
157 | if (ret < 0) |
158 | return ret; |
159 | |
160 | ret = wl1251_cmd_ps_mode(wl, ps_mode: CHIP_ACTIVE_MODE); |
161 | if (ret < 0) |
162 | return ret; |
163 | |
164 | break; |
165 | } |
166 | wl->station_mode = mode; |
167 | |
168 | return ret; |
169 | } |
170 | |
171 | |