1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2019-2020 Realtek Corporation
3 */
4
5 #include "chan.h"
6 #include "coex.h"
7 #include "core.h"
8 #include "debug.h"
9 #include "fw.h"
10 #include "mac.h"
11 #include "phy.h"
12 #include "ps.h"
13 #include "reg.h"
14 #include "util.h"
15
rtw89_fw_leave_lps_check(struct rtw89_dev * rtwdev,u8 macid)16 static int rtw89_fw_leave_lps_check(struct rtw89_dev *rtwdev, u8 macid)
17 {
18 const struct rtw89_mac_gen_def *mac = rtwdev->chip->mac_def;
19 u32 pwr_en_bit = 0xE;
20 u32 chk_msk = pwr_en_bit << (4 * macid);
21 u32 polling;
22 int ret;
23
24 ret = read_poll_timeout_atomic(rtw89_read32_mask, polling, !polling,
25 1000, 50000, false, rtwdev,
26 mac->ps_status, chk_msk);
27 if (ret) {
28 rtw89_info(rtwdev, "rtw89: failed to leave lps state\n");
29 return -EBUSY;
30 }
31
32 return 0;
33 }
34
rtw89_ps_power_mode_change_with_hci(struct rtw89_dev * rtwdev,bool enter)35 static void rtw89_ps_power_mode_change_with_hci(struct rtw89_dev *rtwdev,
36 bool enter)
37 {
38 ieee80211_stop_queues(rtwdev->hw);
39 rtwdev->hci.paused = true;
40 flush_work(&rtwdev->txq_work);
41 ieee80211_wake_queues(rtwdev->hw);
42
43 rtw89_hci_pause(rtwdev, true);
44 rtw89_mac_power_mode_change(rtwdev, enter);
45 rtw89_hci_switch_mode(rtwdev, enter);
46 rtw89_hci_pause(rtwdev, false);
47
48 rtwdev->hci.paused = false;
49
50 if (!enter) {
51 local_bh_disable();
52 napi_schedule(&rtwdev->napi);
53 local_bh_enable();
54 }
55 }
56
rtw89_ps_power_mode_change(struct rtw89_dev * rtwdev,bool enter)57 static void rtw89_ps_power_mode_change(struct rtw89_dev *rtwdev, bool enter)
58 {
59 if (rtwdev->chip->low_power_hci_modes & BIT(rtwdev->ps_mode) &&
60 !test_bit(RTW89_FLAG_WOWLAN, rtwdev->flags))
61 rtw89_ps_power_mode_change_with_hci(rtwdev, enter);
62 else
63 rtw89_mac_power_mode_change(rtwdev, enter);
64 }
65
__rtw89_enter_ps_mode(struct rtw89_dev * rtwdev)66 void __rtw89_enter_ps_mode(struct rtw89_dev *rtwdev)
67 {
68 if (!rtwdev->ps_mode)
69 return;
70
71 if (test_and_set_bit(RTW89_FLAG_LOW_POWER_MODE, rtwdev->flags))
72 return;
73
74 rtw89_ps_power_mode_change(rtwdev, true);
75 }
76
__rtw89_leave_ps_mode(struct rtw89_dev * rtwdev)77 void __rtw89_leave_ps_mode(struct rtw89_dev *rtwdev)
78 {
79 if (!rtwdev->ps_mode)
80 return;
81
82 if (test_and_clear_bit(RTW89_FLAG_LOW_POWER_MODE, rtwdev->flags))
83 rtw89_ps_power_mode_change(rtwdev, false);
84 }
85
__rtw89_enter_lps_link(struct rtw89_dev * rtwdev,struct rtw89_vif_link * rtwvif_link)86 static void __rtw89_enter_lps_link(struct rtw89_dev *rtwdev,
87 struct rtw89_vif_link *rtwvif_link)
88 {
89 struct rtw89_lps_parm lps_param = {
90 .macid = rtwvif_link->mac_id,
91 .psmode = RTW89_MAC_AX_PS_MODE_LEGACY,
92 .lastrpwm = RTW89_LAST_RPWM_PS,
93 };
94
95 rtw89_btc_ntfy_radio_state(rtwdev, BTC_RFCTRL_FW_CTRL);
96 rtw89_fw_h2c_lps_parm(rtwdev, &lps_param);
97 }
98
__rtw89_leave_lps(struct rtw89_dev * rtwdev,struct rtw89_vif_link * rtwvif_link)99 static void __rtw89_leave_lps(struct rtw89_dev *rtwdev,
100 struct rtw89_vif_link *rtwvif_link)
101 {
102 struct rtw89_lps_parm lps_param = {
103 .macid = rtwvif_link->mac_id,
104 .psmode = RTW89_MAC_AX_PS_MODE_ACTIVE,
105 .lastrpwm = RTW89_LAST_RPWM_ACTIVE,
106 };
107
108 rtw89_fw_h2c_lps_parm(rtwdev, &lps_param);
109 rtw89_fw_leave_lps_check(rtwdev, 0);
110 rtw89_btc_ntfy_radio_state(rtwdev, BTC_RFCTRL_WL_ON);
111 rtw89_chip_digital_pwr_comp(rtwdev, rtwvif_link->phy_idx);
112 }
113
rtw89_leave_ps_mode(struct rtw89_dev * rtwdev)114 void rtw89_leave_ps_mode(struct rtw89_dev *rtwdev)
115 {
116 lockdep_assert_held(&rtwdev->mutex);
117
118 __rtw89_leave_ps_mode(rtwdev);
119 }
120
rtw89_enter_lps(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif,bool ps_mode)121 void rtw89_enter_lps(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif,
122 bool ps_mode)
123 {
124 struct rtw89_vif_link *rtwvif_link;
125 bool can_ps_mode = true;
126 unsigned int link_id;
127
128 lockdep_assert_held(&rtwdev->mutex);
129
130 if (test_and_set_bit(RTW89_FLAG_LEISURE_PS, rtwdev->flags))
131 return;
132
133 rtw89_vif_for_each_link(rtwvif, rtwvif_link, link_id) {
134 __rtw89_enter_lps_link(rtwdev, rtwvif_link);
135
136 if (rtwvif_link->wifi_role == RTW89_WIFI_ROLE_P2P_CLIENT)
137 can_ps_mode = false;
138 }
139
140 if (RTW89_CHK_FW_FEATURE(LPS_CH_INFO, &rtwdev->fw))
141 rtw89_fw_h2c_lps_ch_info(rtwdev, rtwvif);
142 else
143 rtw89_fw_h2c_lps_ml_cmn_info(rtwdev, rtwvif);
144
145 if (ps_mode && can_ps_mode)
146 __rtw89_enter_ps_mode(rtwdev);
147 }
148
rtw89_leave_lps_vif(struct rtw89_dev * rtwdev,struct rtw89_vif_link * rtwvif_link)149 static void rtw89_leave_lps_vif(struct rtw89_dev *rtwdev,
150 struct rtw89_vif_link *rtwvif_link)
151 {
152 if (rtwvif_link->wifi_role != RTW89_WIFI_ROLE_STATION &&
153 rtwvif_link->wifi_role != RTW89_WIFI_ROLE_P2P_CLIENT)
154 return;
155
156 __rtw89_leave_lps(rtwdev, rtwvif_link);
157 }
158
rtw89_leave_lps(struct rtw89_dev * rtwdev)159 void rtw89_leave_lps(struct rtw89_dev *rtwdev)
160 {
161 struct rtw89_vif_link *rtwvif_link;
162 struct rtw89_vif *rtwvif;
163 unsigned int link_id;
164
165 lockdep_assert_held(&rtwdev->mutex);
166
167 if (!test_and_clear_bit(RTW89_FLAG_LEISURE_PS, rtwdev->flags))
168 return;
169
170 __rtw89_leave_ps_mode(rtwdev);
171
172 rtw89_phy_dm_reinit(rtwdev);
173
174 rtw89_for_each_rtwvif(rtwdev, rtwvif)
175 rtw89_vif_for_each_link(rtwvif, rtwvif_link, link_id)
176 rtw89_leave_lps_vif(rtwdev, rtwvif_link);
177 }
178
rtw89_enter_ips(struct rtw89_dev * rtwdev)179 void rtw89_enter_ips(struct rtw89_dev *rtwdev)
180 {
181 struct rtw89_vif_link *rtwvif_link;
182 struct rtw89_vif *rtwvif;
183 unsigned int link_id;
184
185 set_bit(RTW89_FLAG_INACTIVE_PS, rtwdev->flags);
186
187 if (!test_bit(RTW89_FLAG_POWERON, rtwdev->flags))
188 return;
189
190 rtw89_for_each_rtwvif(rtwdev, rtwvif)
191 rtw89_vif_for_each_link(rtwvif, rtwvif_link, link_id)
192 rtw89_mac_vif_deinit(rtwdev, rtwvif_link);
193
194 rtw89_core_stop(rtwdev);
195 }
196
rtw89_leave_ips(struct rtw89_dev * rtwdev)197 void rtw89_leave_ips(struct rtw89_dev *rtwdev)
198 {
199 struct rtw89_vif_link *rtwvif_link;
200 struct rtw89_vif *rtwvif;
201 unsigned int link_id;
202 int ret;
203
204 if (test_bit(RTW89_FLAG_POWERON, rtwdev->flags))
205 return;
206
207 ret = rtw89_core_start(rtwdev);
208 if (ret)
209 rtw89_err(rtwdev, "failed to leave idle state\n");
210
211 rtw89_set_channel(rtwdev);
212
213 rtw89_for_each_rtwvif(rtwdev, rtwvif)
214 rtw89_vif_for_each_link(rtwvif, rtwvif_link, link_id)
215 rtw89_mac_vif_init(rtwdev, rtwvif_link);
216
217 clear_bit(RTW89_FLAG_INACTIVE_PS, rtwdev->flags);
218 }
219
rtw89_set_coex_ctrl_lps(struct rtw89_dev * rtwdev,bool btc_ctrl)220 void rtw89_set_coex_ctrl_lps(struct rtw89_dev *rtwdev, bool btc_ctrl)
221 {
222 if (btc_ctrl)
223 rtw89_leave_lps(rtwdev);
224 }
225
rtw89_tsf32_toggle(struct rtw89_dev * rtwdev,struct rtw89_vif_link * rtwvif_link,enum rtw89_p2pps_action act)226 static void rtw89_tsf32_toggle(struct rtw89_dev *rtwdev,
227 struct rtw89_vif_link *rtwvif_link,
228 enum rtw89_p2pps_action act)
229 {
230 if (act == RTW89_P2P_ACT_UPDATE || act == RTW89_P2P_ACT_REMOVE)
231 return;
232
233 if (act == RTW89_P2P_ACT_INIT)
234 rtw89_fw_h2c_tsf32_toggle(rtwdev, rtwvif_link, true);
235 else if (act == RTW89_P2P_ACT_TERMINATE)
236 rtw89_fw_h2c_tsf32_toggle(rtwdev, rtwvif_link, false);
237 }
238
rtw89_p2p_disable_all_noa(struct rtw89_dev * rtwdev,struct rtw89_vif_link * rtwvif_link,struct ieee80211_bss_conf * bss_conf)239 static void rtw89_p2p_disable_all_noa(struct rtw89_dev *rtwdev,
240 struct rtw89_vif_link *rtwvif_link,
241 struct ieee80211_bss_conf *bss_conf)
242 {
243 enum rtw89_p2pps_action act;
244 u8 noa_id;
245
246 if (rtwvif_link->last_noa_nr == 0)
247 return;
248
249 for (noa_id = 0; noa_id < rtwvif_link->last_noa_nr; noa_id++) {
250 if (noa_id == rtwvif_link->last_noa_nr - 1)
251 act = RTW89_P2P_ACT_TERMINATE;
252 else
253 act = RTW89_P2P_ACT_REMOVE;
254 rtw89_tsf32_toggle(rtwdev, rtwvif_link, act);
255 rtw89_fw_h2c_p2p_act(rtwdev, rtwvif_link, bss_conf,
256 NULL, act, noa_id);
257 }
258 }
259
rtw89_p2p_update_noa(struct rtw89_dev * rtwdev,struct rtw89_vif_link * rtwvif_link,struct ieee80211_bss_conf * bss_conf)260 static void rtw89_p2p_update_noa(struct rtw89_dev *rtwdev,
261 struct rtw89_vif_link *rtwvif_link,
262 struct ieee80211_bss_conf *bss_conf)
263 {
264 struct ieee80211_p2p_noa_desc *desc;
265 enum rtw89_p2pps_action act;
266 u8 noa_id;
267
268 for (noa_id = 0; noa_id < RTW89_P2P_MAX_NOA_NUM; noa_id++) {
269 desc = &bss_conf->p2p_noa_attr.desc[noa_id];
270 if (!desc->count || !desc->duration)
271 break;
272
273 if (noa_id == 0)
274 act = RTW89_P2P_ACT_INIT;
275 else
276 act = RTW89_P2P_ACT_UPDATE;
277 rtw89_tsf32_toggle(rtwdev, rtwvif_link, act);
278 rtw89_fw_h2c_p2p_act(rtwdev, rtwvif_link, bss_conf,
279 desc, act, noa_id);
280 }
281 rtwvif_link->last_noa_nr = noa_id;
282 }
283
rtw89_process_p2p_ps(struct rtw89_dev * rtwdev,struct rtw89_vif_link * rtwvif_link,struct ieee80211_bss_conf * bss_conf)284 void rtw89_process_p2p_ps(struct rtw89_dev *rtwdev,
285 struct rtw89_vif_link *rtwvif_link,
286 struct ieee80211_bss_conf *bss_conf)
287 {
288 rtw89_p2p_disable_all_noa(rtwdev, rtwvif_link, bss_conf);
289 rtw89_p2p_update_noa(rtwdev, rtwvif_link, bss_conf);
290 }
291
rtw89_recalc_lps(struct rtw89_dev * rtwdev)292 void rtw89_recalc_lps(struct rtw89_dev *rtwdev)
293 {
294 struct ieee80211_vif *vif, *found_vif = NULL;
295 struct rtw89_vif *rtwvif;
296 enum rtw89_entity_mode mode;
297 int count = 0;
298
299 mode = rtw89_get_entity_mode(rtwdev);
300 if (mode == RTW89_ENTITY_MODE_MCC)
301 goto disable_lps;
302
303 rtw89_for_each_rtwvif(rtwdev, rtwvif) {
304 vif = rtwvif_to_vif(rtwvif);
305
306 if (vif->type != NL80211_IFTYPE_STATION) {
307 count = 0;
308 break;
309 }
310
311 count++;
312 found_vif = vif;
313 }
314
315 if (count == 1 && found_vif->cfg.ps) {
316 rtwdev->lps_enabled = true;
317 return;
318 }
319
320 disable_lps:
321 rtw89_leave_lps(rtwdev);
322 rtwdev->lps_enabled = false;
323 }
324
rtw89_p2p_noa_renew(struct rtw89_vif_link * rtwvif_link)325 void rtw89_p2p_noa_renew(struct rtw89_vif_link *rtwvif_link)
326 {
327 struct rtw89_p2p_noa_setter *setter = &rtwvif_link->p2p_noa;
328 struct rtw89_p2p_noa_ie *ie = &setter->ie;
329 struct rtw89_p2p_ie_head *p2p_head = &ie->p2p_head;
330 struct rtw89_noa_attr_head *noa_head = &ie->noa_head;
331
332 if (setter->noa_count) {
333 setter->noa_index++;
334 setter->noa_count = 0;
335 }
336
337 memset(ie, 0, sizeof(*ie));
338
339 p2p_head->eid = WLAN_EID_VENDOR_SPECIFIC;
340 p2p_head->ie_len = 4 + sizeof(*noa_head);
341 p2p_head->oui[0] = (WLAN_OUI_WFA >> 16) & 0xff;
342 p2p_head->oui[1] = (WLAN_OUI_WFA >> 8) & 0xff;
343 p2p_head->oui[2] = (WLAN_OUI_WFA >> 0) & 0xff;
344 p2p_head->oui_type = WLAN_OUI_TYPE_WFA_P2P;
345
346 noa_head->attr_type = IEEE80211_P2P_ATTR_ABSENCE_NOTICE;
347 noa_head->attr_len = cpu_to_le16(2);
348 noa_head->index = setter->noa_index;
349 noa_head->oppps_ctwindow = 0;
350 }
351
rtw89_p2p_noa_append(struct rtw89_vif_link * rtwvif_link,const struct ieee80211_p2p_noa_desc * desc)352 void rtw89_p2p_noa_append(struct rtw89_vif_link *rtwvif_link,
353 const struct ieee80211_p2p_noa_desc *desc)
354 {
355 struct rtw89_p2p_noa_setter *setter = &rtwvif_link->p2p_noa;
356 struct rtw89_p2p_noa_ie *ie = &setter->ie;
357 struct rtw89_p2p_ie_head *p2p_head = &ie->p2p_head;
358 struct rtw89_noa_attr_head *noa_head = &ie->noa_head;
359
360 if (!desc->count || !desc->duration)
361 return;
362
363 if (setter->noa_count >= RTW89_P2P_MAX_NOA_NUM)
364 return;
365
366 p2p_head->ie_len += sizeof(*desc);
367 le16_add_cpu(&noa_head->attr_len, sizeof(*desc));
368
369 ie->noa_desc[setter->noa_count++] = *desc;
370 }
371
rtw89_p2p_noa_fetch(struct rtw89_vif_link * rtwvif_link,void ** data)372 u8 rtw89_p2p_noa_fetch(struct rtw89_vif_link *rtwvif_link, void **data)
373 {
374 struct rtw89_p2p_noa_setter *setter = &rtwvif_link->p2p_noa;
375 struct rtw89_p2p_noa_ie *ie = &setter->ie;
376 void *tail;
377
378 if (!setter->noa_count)
379 return 0;
380
381 *data = ie;
382 tail = ie->noa_desc + setter->noa_count;
383 return tail - *data;
384 }
385