]>
Commit | Line | Data |
---|---|---|
d27a76fa LF |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* Copyright(c) 2009-2012 Realtek Corporation.*/ | |
0c817338 LF |
3 | |
4 | #include "wifi.h" | |
5 | #include "core.h" | |
6 | #include "cam.h" | |
7 | #include "base.h" | |
8 | #include "ps.h" | |
34ed780a | 9 | #include "pwrseqcmd.h" |
0c817338 | 10 | |
f7953b2a LF |
11 | #include "btcoexist/rtl_btc.h" |
12 | #include <linux/firmware.h> | |
b0302aba | 13 | #include <linux/export.h> |
f7953b2a | 14 | #include <net/cfg80211.h> |
b0302aba | 15 | |
9696a159 LF |
16 | u8 channel5g[CHANNEL_MAX_NUMBER_5G] = { |
17 | 36, 38, 40, 42, 44, 46, 48, /* Band 1 */ | |
18 | 52, 54, 56, 58, 60, 62, 64, /* Band 2 */ | |
19 | 100, 102, 104, 106, 108, 110, 112, /* Band 3 */ | |
20 | 116, 118, 120, 122, 124, 126, 128, /* Band 3 */ | |
21 | 132, 134, 136, 138, 140, 142, 144, /* Band 3 */ | |
22 | 149, 151, 153, 155, 157, 159, 161, /* Band 4 */ | |
23 | 165, 167, 169, 171, 173, 175, 177 /* Band 4 */ | |
24 | }; | |
25 | EXPORT_SYMBOL(channel5g); | |
26 | ||
27 | u8 channel5g_80m[CHANNEL_MAX_NUMBER_5G_80M] = { | |
28 | 42, 58, 106, 122, 138, 155, 171 | |
29 | }; | |
30 | EXPORT_SYMBOL(channel5g_80m); | |
31 | ||
25b13dbc LF |
32 | void rtl_addr_delay(u32 addr) |
33 | { | |
34 | if (addr == 0xfe) | |
de26859d | 35 | mdelay(50); |
25b13dbc | 36 | else if (addr == 0xfd) |
49f86ec2 | 37 | msleep(5); |
25b13dbc | 38 | else if (addr == 0xfc) |
49f86ec2 | 39 | msleep(1); |
25b13dbc | 40 | else if (addr == 0xfb) |
49f86ec2 | 41 | usleep_range(50, 100); |
25b13dbc | 42 | else if (addr == 0xfa) |
49f86ec2 | 43 | usleep_range(5, 10); |
25b13dbc | 44 | else if (addr == 0xf9) |
49f86ec2 | 45 | usleep_range(1, 2); |
25b13dbc LF |
46 | } |
47 | EXPORT_SYMBOL(rtl_addr_delay); | |
48 | ||
49 | void rtl_rfreg_delay(struct ieee80211_hw *hw, enum radio_path rfpath, u32 addr, | |
50 | u32 mask, u32 data) | |
51 | { | |
49f86ec2 LF |
52 | if (addr >= 0xf9 && addr <= 0xfe) { |
53 | rtl_addr_delay(addr); | |
25b13dbc LF |
54 | } else { |
55 | rtl_set_rfreg(hw, rfpath, addr, mask, data); | |
de26859d | 56 | udelay(1); |
25b13dbc LF |
57 | } |
58 | } | |
59 | EXPORT_SYMBOL(rtl_rfreg_delay); | |
60 | ||
61 | void rtl_bb_delay(struct ieee80211_hw *hw, u32 addr, u32 data) | |
62 | { | |
49f86ec2 LF |
63 | if (addr >= 0xf9 && addr <= 0xfe) { |
64 | rtl_addr_delay(addr); | |
25b13dbc LF |
65 | } else { |
66 | rtl_set_bbreg(hw, addr, MASKDWORD, data); | |
de26859d | 67 | udelay(1); |
25b13dbc LF |
68 | } |
69 | } | |
70 | EXPORT_SYMBOL(rtl_bb_delay); | |
71 | ||
fe89707f TT |
72 | static void rtl_fw_do_work(const struct firmware *firmware, void *context, |
73 | bool is_wow) | |
b0302aba LF |
74 | { |
75 | struct ieee80211_hw *hw = context; | |
76 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
77 | int err; | |
78 | ||
79 | RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD, | |
f7953b2a | 80 | "Firmware callback routine entered!\n"); |
b0302aba LF |
81 | complete(&rtlpriv->firmware_loading_complete); |
82 | if (!firmware) { | |
62009b7f LF |
83 | if (rtlpriv->cfg->alt_fw_name) { |
84 | err = request_firmware(&firmware, | |
85 | rtlpriv->cfg->alt_fw_name, | |
86 | rtlpriv->io.dev); | |
87 | pr_info("Loading alternative firmware %s\n", | |
88 | rtlpriv->cfg->alt_fw_name); | |
89 | if (!err) | |
90 | goto found_alt; | |
91 | } | |
cf4747d7 | 92 | pr_err("Selected firmware is not available\n"); |
b0302aba LF |
93 | rtlpriv->max_fw_size = 0; |
94 | return; | |
95 | } | |
62009b7f | 96 | found_alt: |
b0302aba | 97 | if (firmware->size > rtlpriv->max_fw_size) { |
b03d968b | 98 | pr_err("Firmware is too big!\n"); |
b0302aba LF |
99 | release_firmware(firmware); |
100 | return; | |
101 | } | |
fe89707f TT |
102 | if (!is_wow) { |
103 | memcpy(rtlpriv->rtlhal.pfirmware, firmware->data, | |
104 | firmware->size); | |
105 | rtlpriv->rtlhal.fwsize = firmware->size; | |
106 | } else { | |
107 | memcpy(rtlpriv->rtlhal.wowlan_firmware, firmware->data, | |
108 | firmware->size); | |
109 | rtlpriv->rtlhal.wowlan_fwsize = firmware->size; | |
110 | } | |
b0302aba | 111 | release_firmware(firmware); |
b0302aba | 112 | } |
fe89707f TT |
113 | |
114 | void rtl_fw_cb(const struct firmware *firmware, void *context) | |
115 | { | |
116 | rtl_fw_do_work(firmware, context, false); | |
117 | } | |
b0302aba LF |
118 | EXPORT_SYMBOL(rtl_fw_cb); |
119 | ||
fe89707f TT |
120 | void rtl_wowlan_fw_cb(const struct firmware *firmware, void *context) |
121 | { | |
122 | rtl_fw_do_work(firmware, context, true); | |
123 | } | |
124 | EXPORT_SYMBOL(rtl_wowlan_fw_cb); | |
125 | ||
0c817338 LF |
126 | /*mutex for start & stop is must here. */ |
127 | static int rtl_op_start(struct ieee80211_hw *hw) | |
128 | { | |
f7953b2a | 129 | int err = 0; |
0c817338 LF |
130 | struct rtl_priv *rtlpriv = rtl_priv(hw); |
131 | struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); | |
132 | ||
133 | if (!is_hal_stop(rtlhal)) | |
134 | return 0; | |
135 | if (!test_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status)) | |
136 | return 0; | |
8a09d6d8 | 137 | mutex_lock(&rtlpriv->locks.conf_mutex); |
0c817338 | 138 | err = rtlpriv->intf_ops->adapter_start(hw); |
32473284 | 139 | if (!err) |
7c51d17c | 140 | rtl_watch_dog_timer_callback(&rtlpriv->works.watchdog_timer); |
8a09d6d8 | 141 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
142 | return err; |
143 | } | |
144 | ||
145 | static void rtl_op_stop(struct ieee80211_hw *hw) | |
146 | { | |
147 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
148 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
149 | struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); | |
150 | struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); | |
f7953b2a | 151 | bool support_remote_wakeup = false; |
0c817338 LF |
152 | |
153 | if (is_hal_stop(rtlhal)) | |
154 | return; | |
155 | ||
f7953b2a LF |
156 | rtlpriv->cfg->ops->get_hw_reg(hw, HAL_DEF_WOWLAN, |
157 | (u8 *)(&support_remote_wakeup)); | |
26634c4b LF |
158 | /* here is must, because adhoc do stop and start, |
159 | * but stop with RFOFF may cause something wrong, | |
160 | * like adhoc TP | |
161 | */ | |
f7953b2a | 162 | if (unlikely(ppsc->rfpwr_state == ERFOFF)) |
0c817338 | 163 | rtl_ips_nic_on(hw); |
0c817338 | 164 | |
8a09d6d8 | 165 | mutex_lock(&rtlpriv->locks.conf_mutex); |
f7953b2a LF |
166 | /* if wowlan supported, DON'T clear connected info */ |
167 | if (!(support_remote_wakeup && | |
168 | rtlhal->enter_pnp_sleep)) { | |
169 | mac->link_state = MAC80211_NOLINK; | |
93803b33 | 170 | eth_zero_addr(mac->bssid); |
f7953b2a | 171 | mac->vendor = PEER_UNKNOWN; |
0c817338 | 172 | |
f7953b2a LF |
173 | /* reset sec info */ |
174 | rtl_cam_reset_sec_info(hw); | |
0c817338 | 175 | |
12dfa2f6 | 176 | rtl_deinit_deferred_work(hw, false); |
f7953b2a | 177 | } |
0c817338 LF |
178 | rtlpriv->intf_ops->adapter_stop(hw); |
179 | ||
8a09d6d8 | 180 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
181 | } |
182 | ||
36323f81 TH |
183 | static void rtl_op_tx(struct ieee80211_hw *hw, |
184 | struct ieee80211_tx_control *control, | |
185 | struct sk_buff *skb) | |
0c817338 LF |
186 | { |
187 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
188 | struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); | |
189 | struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); | |
0baa0fd7 | 190 | struct rtl_tcb_desc tcb_desc; |
b16abaaf | 191 | |
0baa0fd7 | 192 | memset(&tcb_desc, 0, sizeof(struct rtl_tcb_desc)); |
0c817338 LF |
193 | |
194 | if (unlikely(is_hal_stop(rtlhal) || ppsc->rfpwr_state != ERFON)) | |
195 | goto err_free; | |
196 | ||
197 | if (!test_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status)) | |
198 | goto err_free; | |
199 | ||
36323f81 TH |
200 | if (!rtlpriv->intf_ops->waitq_insert(hw, control->sta, skb)) |
201 | rtlpriv->intf_ops->adapter_tx(hw, control->sta, skb, &tcb_desc); | |
7bb45683 | 202 | return; |
0c817338 LF |
203 | |
204 | err_free: | |
205 | dev_kfree_skb_any(skb); | |
0c817338 LF |
206 | } |
207 | ||
208 | static int rtl_op_add_interface(struct ieee80211_hw *hw, | |
209 | struct ieee80211_vif *vif) | |
210 | { | |
211 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
212 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
213 | int err = 0; | |
8d0d43e3 | 214 | u8 retry_limit = 0x30; |
0c817338 LF |
215 | |
216 | if (mac->vif) { | |
217 | RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, | |
f30d7507 | 218 | "vif has been set!! mac->vif = 0x%p\n", mac->vif); |
0c817338 LF |
219 | return -EOPNOTSUPP; |
220 | } | |
221 | ||
f7953b2a LF |
222 | vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER; |
223 | ||
0c817338 LF |
224 | rtl_ips_nic_on(hw); |
225 | ||
8a09d6d8 | 226 | mutex_lock(&rtlpriv->locks.conf_mutex); |
26634c4b LF |
227 | switch (ieee80211_vif_type_p2p(vif)) { |
228 | case NL80211_IFTYPE_P2P_CLIENT: | |
229 | mac->p2p = P2P_ROLE_CLIENT; | |
230 | /*fall through*/ | |
0c817338 LF |
231 | case NL80211_IFTYPE_STATION: |
232 | if (mac->beacon_enabled == 1) { | |
233 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f30d7507 | 234 | "NL80211_IFTYPE_STATION\n"); |
0c817338 LF |
235 | mac->beacon_enabled = 0; |
236 | rtlpriv->cfg->ops->update_interrupt_mask(hw, 0, | |
f7953b2a | 237 | rtlpriv->cfg->maps[RTL_IBSS_INT_MASKS]); |
0c817338 LF |
238 | } |
239 | break; | |
240 | case NL80211_IFTYPE_ADHOC: | |
241 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f30d7507 | 242 | "NL80211_IFTYPE_ADHOC\n"); |
0c817338 LF |
243 | |
244 | mac->link_state = MAC80211_LINKED; | |
245 | rtlpriv->cfg->ops->set_bcn_reg(hw); | |
0baa0fd7 C |
246 | if (rtlpriv->rtlhal.current_bandtype == BAND_ON_2_4G) |
247 | mac->basic_rates = 0xfff; | |
248 | else | |
249 | mac->basic_rates = 0xff0; | |
250 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE, | |
f7953b2a | 251 | (u8 *)(&mac->basic_rates)); |
0baa0fd7 | 252 | |
8d0d43e3 | 253 | retry_limit = 0x07; |
0c817338 | 254 | break; |
26634c4b LF |
255 | case NL80211_IFTYPE_P2P_GO: |
256 | mac->p2p = P2P_ROLE_GO; | |
257 | /*fall through*/ | |
0c817338 LF |
258 | case NL80211_IFTYPE_AP: |
259 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f30d7507 | 260 | "NL80211_IFTYPE_AP\n"); |
0baa0fd7 C |
261 | |
262 | mac->link_state = MAC80211_LINKED; | |
263 | rtlpriv->cfg->ops->set_bcn_reg(hw); | |
264 | if (rtlpriv->rtlhal.current_bandtype == BAND_ON_2_4G) | |
265 | mac->basic_rates = 0xfff; | |
266 | else | |
267 | mac->basic_rates = 0xff0; | |
268 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE, | |
f7953b2a | 269 | (u8 *)(&mac->basic_rates)); |
8d0d43e3 PKS |
270 | |
271 | retry_limit = 0x07; | |
0c817338 | 272 | break; |
26634c4b LF |
273 | case NL80211_IFTYPE_MESH_POINT: |
274 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
275 | "NL80211_IFTYPE_MESH_POINT\n"); | |
276 | ||
277 | mac->link_state = MAC80211_LINKED; | |
278 | rtlpriv->cfg->ops->set_bcn_reg(hw); | |
279 | if (rtlpriv->rtlhal.current_bandtype == BAND_ON_2_4G) | |
280 | mac->basic_rates = 0xfff; | |
281 | else | |
282 | mac->basic_rates = 0xff0; | |
283 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE, | |
284 | (u8 *)(&mac->basic_rates)); | |
8d0d43e3 PKS |
285 | |
286 | retry_limit = 0x07; | |
26634c4b | 287 | break; |
0c817338 | 288 | default: |
b03d968b LF |
289 | pr_err("operation mode %d is not supported!\n", |
290 | vif->type); | |
0c817338 LF |
291 | err = -EOPNOTSUPP; |
292 | goto out; | |
293 | } | |
294 | ||
26634c4b LF |
295 | if (mac->p2p) { |
296 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
297 | "p2p role %x\n", vif->type); | |
298 | mac->basic_rates = 0xff0;/*disable cck rate for p2p*/ | |
299 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE, | |
300 | (u8 *)(&mac->basic_rates)); | |
301 | } | |
0c817338 LF |
302 | mac->vif = vif; |
303 | mac->opmode = vif->type; | |
304 | rtlpriv->cfg->ops->set_network_type(hw, vif->type); | |
305 | memcpy(mac->mac_addr, vif->addr, ETH_ALEN); | |
306 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_ETHER_ADDR, mac->mac_addr); | |
307 | ||
8d0d43e3 PKS |
308 | mac->retry_long = retry_limit; |
309 | mac->retry_short = retry_limit; | |
310 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RETRY_LIMIT, | |
311 | (u8 *)(&retry_limit)); | |
0c817338 | 312 | out: |
8a09d6d8 | 313 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
314 | return err; |
315 | } | |
316 | ||
317 | static void rtl_op_remove_interface(struct ieee80211_hw *hw, | |
318 | struct ieee80211_vif *vif) | |
319 | { | |
320 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
321 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
322 | ||
8a09d6d8 | 323 | mutex_lock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
324 | |
325 | /* Free beacon resources */ | |
d63589cb FCB |
326 | if (vif->type == NL80211_IFTYPE_AP || |
327 | vif->type == NL80211_IFTYPE_ADHOC || | |
328 | vif->type == NL80211_IFTYPE_MESH_POINT) { | |
0c817338 LF |
329 | if (mac->beacon_enabled == 1) { |
330 | mac->beacon_enabled = 0; | |
331 | rtlpriv->cfg->ops->update_interrupt_mask(hw, 0, | |
f7953b2a | 332 | rtlpriv->cfg->maps[RTL_IBSS_INT_MASKS]); |
0c817338 LF |
333 | } |
334 | } | |
335 | ||
336 | /* | |
337 | *Note: We assume NL80211_IFTYPE_UNSPECIFIED as | |
338 | *NO LINK for our hardware. | |
339 | */ | |
26634c4b | 340 | mac->p2p = 0; |
0c817338 LF |
341 | mac->vif = NULL; |
342 | mac->link_state = MAC80211_NOLINK; | |
93803b33 | 343 | eth_zero_addr(mac->bssid); |
0baa0fd7 | 344 | mac->vendor = PEER_UNKNOWN; |
0c817338 LF |
345 | mac->opmode = NL80211_IFTYPE_UNSPECIFIED; |
346 | rtlpriv->cfg->ops->set_network_type(hw, mac->opmode); | |
f7953b2a | 347 | |
8a09d6d8 | 348 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 | 349 | } |
b16abaaf | 350 | |
26634c4b | 351 | static int rtl_op_change_interface(struct ieee80211_hw *hw, |
f7953b2a LF |
352 | struct ieee80211_vif *vif, |
353 | enum nl80211_iftype new_type, bool p2p) | |
26634c4b LF |
354 | { |
355 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
356 | int ret; | |
b16abaaf | 357 | |
26634c4b LF |
358 | rtl_op_remove_interface(hw, vif); |
359 | ||
360 | vif->type = new_type; | |
361 | vif->p2p = p2p; | |
362 | ret = rtl_op_add_interface(hw, vif); | |
363 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f7953b2a | 364 | "p2p %x\n", p2p); |
26634c4b LF |
365 | return ret; |
366 | } | |
367 | ||
f7953b2a LF |
368 | #ifdef CONFIG_PM |
369 | static u16 crc16_ccitt(u8 data, u16 crc) | |
370 | { | |
371 | u8 shift_in, data_bit, crc_bit11, crc_bit4, crc_bit15; | |
372 | u8 i; | |
373 | u16 result; | |
374 | ||
375 | for (i = 0; i < 8; i++) { | |
376 | crc_bit15 = ((crc & BIT(15)) ? 1 : 0); | |
377 | data_bit = (data & (BIT(0) << i) ? 1 : 0); | |
378 | shift_in = crc_bit15 ^ data_bit; | |
379 | ||
380 | result = crc << 1; | |
381 | if (shift_in == 0) | |
382 | result &= (~BIT(0)); | |
383 | else | |
384 | result |= BIT(0); | |
385 | ||
386 | crc_bit11 = ((crc & BIT(11)) ? 1 : 0) ^ shift_in; | |
387 | if (crc_bit11 == 0) | |
388 | result &= (~BIT(12)); | |
389 | else | |
390 | result |= BIT(12); | |
391 | ||
392 | crc_bit4 = ((crc & BIT(4)) ? 1 : 0) ^ shift_in; | |
393 | if (crc_bit4 == 0) | |
394 | result &= (~BIT(5)); | |
395 | else | |
396 | result |= BIT(5); | |
397 | ||
398 | crc = result; | |
399 | } | |
400 | ||
401 | return crc; | |
402 | } | |
403 | ||
404 | static u16 _calculate_wol_pattern_crc(u8 *pattern, u16 len) | |
405 | { | |
406 | u16 crc = 0xffff; | |
407 | u32 i; | |
408 | ||
409 | for (i = 0; i < len; i++) | |
410 | crc = crc16_ccitt(pattern[i], crc); | |
411 | ||
412 | crc = ~crc; | |
413 | ||
414 | return crc; | |
415 | } | |
416 | ||
417 | static void _rtl_add_wowlan_patterns(struct ieee80211_hw *hw, | |
418 | struct cfg80211_wowlan *wow) | |
419 | { | |
420 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
421 | struct rtl_mac *mac = &rtlpriv->mac80211; | |
422 | struct cfg80211_pkt_pattern *patterns = wow->patterns; | |
423 | struct rtl_wow_pattern rtl_pattern; | |
424 | const u8 *pattern_os, *mask_os; | |
425 | u8 mask[MAX_WOL_BIT_MASK_SIZE] = {0}; | |
426 | u8 content[MAX_WOL_PATTERN_SIZE] = {0}; | |
427 | u8 broadcast_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; | |
428 | u8 multicast_addr1[2] = {0x33, 0x33}; | |
429 | u8 multicast_addr2[3] = {0x01, 0x00, 0x5e}; | |
430 | u8 i, mask_len; | |
431 | u16 j, len; | |
432 | ||
433 | for (i = 0; i < wow->n_patterns; i++) { | |
434 | memset(&rtl_pattern, 0, sizeof(struct rtl_wow_pattern)); | |
435 | memset(mask, 0, MAX_WOL_BIT_MASK_SIZE); | |
64e79426 DC |
436 | if (patterns[i].pattern_len < 0 || |
437 | patterns[i].pattern_len > MAX_WOL_PATTERN_SIZE) { | |
f7953b2a LF |
438 | RT_TRACE(rtlpriv, COMP_POWER, DBG_WARNING, |
439 | "Pattern[%d] is too long\n", i); | |
440 | continue; | |
441 | } | |
442 | pattern_os = patterns[i].pattern; | |
443 | mask_len = DIV_ROUND_UP(patterns[i].pattern_len, 8); | |
444 | mask_os = patterns[i].mask; | |
445 | RT_PRINT_DATA(rtlpriv, COMP_POWER, DBG_TRACE, | |
446 | "pattern content\n", pattern_os, | |
447 | patterns[i].pattern_len); | |
448 | RT_PRINT_DATA(rtlpriv, COMP_POWER, DBG_TRACE, | |
449 | "mask content\n", mask_os, mask_len); | |
450 | /* 1. unicast? multicast? or broadcast? */ | |
451 | if (memcmp(pattern_os, broadcast_addr, 6) == 0) | |
452 | rtl_pattern.type = BROADCAST_PATTERN; | |
453 | else if (memcmp(pattern_os, multicast_addr1, 2) == 0 || | |
454 | memcmp(pattern_os, multicast_addr2, 3) == 0) | |
455 | rtl_pattern.type = MULTICAST_PATTERN; | |
456 | else if (memcmp(pattern_os, mac->mac_addr, 6) == 0) | |
457 | rtl_pattern.type = UNICAST_PATTERN; | |
458 | else | |
459 | rtl_pattern.type = UNKNOWN_TYPE; | |
460 | ||
461 | /* 2. translate mask_from_os to mask_for_hw */ | |
462 | ||
463 | /****************************************************************************** | |
464 | * pattern from OS uses 'ethenet frame', like this: | |
465 | ||
466 | | 6 | 6 | 2 | 20 | Variable | 4 | | |
467 | |--------+--------+------+-----------+------------+-----| | |
468 | | 802.3 Mac Header | IP Header | TCP Packet | FCS | | |
469 | | DA | SA | Type | | |
470 | ||
471 | * BUT, packet catched by our HW is in '802.11 frame', begin from LLC, | |
472 | ||
473 | | 24 or 30 | 6 | 2 | 20 | Variable | 4 | | |
474 | |-------------------+--------+------+-----------+------------+-----| | |
475 | | 802.11 MAC Header | LLC | IP Header | TCP Packet | FCS | | |
476 | | Others | Tpye | | |
477 | ||
478 | * Therefore, we need translate mask_from_OS to mask_to_hw. | |
479 | * We should left-shift mask by 6 bits, then set the new bit[0~5] = 0, | |
480 | * because new mask[0~5] means 'SA', but our HW packet begins from LLC, | |
481 | * bit[0~5] corresponds to first 6 Bytes in LLC, they just don't match. | |
482 | ******************************************************************************/ | |
483 | ||
484 | /* Shift 6 bits */ | |
485 | for (j = 0; j < mask_len - 1; j++) { | |
486 | mask[j] = mask_os[j] >> 6; | |
487 | mask[j] |= (mask_os[j + 1] & 0x3F) << 2; | |
488 | } | |
489 | mask[j] = (mask_os[j] >> 6) & 0x3F; | |
490 | /* Set bit 0-5 to zero */ | |
491 | mask[0] &= 0xC0; | |
492 | ||
493 | RT_PRINT_DATA(rtlpriv, COMP_POWER, DBG_TRACE, | |
494 | "mask to hw\n", mask, mask_len); | |
495 | for (j = 0; j < (MAX_WOL_BIT_MASK_SIZE + 1) / 4; j++) { | |
496 | rtl_pattern.mask[j] = mask[j * 4]; | |
497 | rtl_pattern.mask[j] |= (mask[j * 4 + 1] << 8); | |
498 | rtl_pattern.mask[j] |= (mask[j * 4 + 2] << 16); | |
499 | rtl_pattern.mask[j] |= (mask[j * 4 + 3] << 24); | |
500 | } | |
501 | ||
502 | /* To get the wake up pattern from the mask. | |
503 | * We do not count first 12 bits which means | |
504 | * DA[6] and SA[6] in the pattern to match HW design. | |
505 | */ | |
506 | len = 0; | |
507 | for (j = 12; j < patterns[i].pattern_len; j++) { | |
508 | if ((mask_os[j / 8] >> (j % 8)) & 0x01) { | |
509 | content[len] = pattern_os[j]; | |
510 | len++; | |
511 | } | |
512 | } | |
513 | ||
514 | RT_PRINT_DATA(rtlpriv, COMP_POWER, DBG_TRACE, | |
515 | "pattern to hw\n", content, len); | |
516 | /* 3. calculate crc */ | |
517 | rtl_pattern.crc = _calculate_wol_pattern_crc(content, len); | |
518 | RT_TRACE(rtlpriv, COMP_POWER, DBG_TRACE, | |
4713bd1c | 519 | "CRC_Remainder = 0x%x\n", rtl_pattern.crc); |
f7953b2a LF |
520 | |
521 | /* 4. write crc & mask_for_hw to hw */ | |
522 | rtlpriv->cfg->ops->add_wowlan_pattern(hw, &rtl_pattern, i); | |
523 | } | |
524 | rtl_write_byte(rtlpriv, 0x698, wow->n_patterns); | |
525 | } | |
526 | ||
527 | static int rtl_op_suspend(struct ieee80211_hw *hw, | |
528 | struct cfg80211_wowlan *wow) | |
529 | { | |
530 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
531 | struct rtl_hal *rtlhal = rtl_hal(rtlpriv); | |
532 | struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); | |
f7953b2a LF |
533 | |
534 | RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG, "\n"); | |
535 | if (WARN_ON(!wow)) | |
536 | return -EINVAL; | |
537 | ||
538 | /* to resolve s4 can not wake up*/ | |
3c92d551 | 539 | rtlhal->last_suspend_sec = ktime_get_real_seconds(); |
f7953b2a LF |
540 | |
541 | if ((ppsc->wo_wlan_mode & WAKE_ON_PATTERN_MATCH) && wow->n_patterns) | |
542 | _rtl_add_wowlan_patterns(hw, wow); | |
543 | ||
544 | rtlhal->driver_is_goingto_unload = true; | |
545 | rtlhal->enter_pnp_sleep = true; | |
546 | ||
547 | rtl_lps_leave(hw); | |
548 | rtl_op_stop(hw); | |
549 | device_set_wakeup_enable(wiphy_dev(hw->wiphy), true); | |
550 | return 0; | |
551 | } | |
552 | ||
553 | static int rtl_op_resume(struct ieee80211_hw *hw) | |
554 | { | |
555 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
556 | struct rtl_hal *rtlhal = rtl_hal(rtlpriv); | |
557 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
3c92d551 | 558 | time64_t now; |
f7953b2a LF |
559 | |
560 | RT_TRACE(rtlpriv, COMP_POWER, DBG_DMESG, "\n"); | |
561 | rtlhal->driver_is_goingto_unload = false; | |
562 | rtlhal->enter_pnp_sleep = false; | |
563 | rtlhal->wake_from_pnp_sleep = true; | |
564 | ||
565 | /* to resovle s4 can not wake up*/ | |
3c92d551 AB |
566 | now = ktime_get_real_seconds(); |
567 | if (now - rtlhal->last_suspend_sec < 5) | |
f7953b2a LF |
568 | return -1; |
569 | ||
570 | rtl_op_start(hw); | |
571 | device_set_wakeup_enable(wiphy_dev(hw->wiphy), false); | |
572 | ieee80211_resume_disconnect(mac->vif); | |
573 | rtlhal->wake_from_pnp_sleep = false; | |
574 | return 0; | |
575 | } | |
576 | #endif | |
577 | ||
0c817338 LF |
578 | static int rtl_op_config(struct ieee80211_hw *hw, u32 changed) |
579 | { | |
580 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
581 | struct rtl_phy *rtlphy = &(rtlpriv->phy); | |
582 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
583 | struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); | |
584 | struct ieee80211_conf *conf = &hw->conf; | |
585 | ||
26634c4b LF |
586 | if (mac->skip_scan) |
587 | return 1; | |
588 | ||
8a09d6d8 | 589 | mutex_lock(&rtlpriv->locks.conf_mutex); |
f7953b2a | 590 | if (changed & IEEE80211_CONF_CHANGE_LISTEN_INTERVAL) { /* BIT(2)*/ |
0c817338 | 591 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, |
f30d7507 | 592 | "IEEE80211_CONF_CHANGE_LISTEN_INTERVAL\n"); |
0c817338 LF |
593 | } |
594 | ||
595 | /*For IPS */ | |
596 | if (changed & IEEE80211_CONF_CHANGE_IDLE) { | |
597 | if (hw->conf.flags & IEEE80211_CONF_IDLE) | |
598 | rtl_ips_nic_off(hw); | |
599 | else | |
600 | rtl_ips_nic_on(hw); | |
601 | } else { | |
602 | /* | |
603 | *although rfoff may not cause by ips, but we will | |
604 | *check the reason in set_rf_power_state function | |
605 | */ | |
606 | if (unlikely(ppsc->rfpwr_state == ERFOFF)) | |
607 | rtl_ips_nic_on(hw); | |
608 | } | |
609 | ||
610 | /*For LPS */ | |
e332e2a2 PKS |
611 | if ((changed & IEEE80211_CONF_CHANGE_PS) && |
612 | rtlpriv->psc.swctrl_lps && !rtlpriv->psc.fwctrl_lps) { | |
0baa0fd7 C |
613 | cancel_delayed_work(&rtlpriv->works.ps_work); |
614 | cancel_delayed_work(&rtlpriv->works.ps_rfon_wq); | |
615 | if (conf->flags & IEEE80211_CONF_PS) { | |
616 | rtlpriv->psc.sw_ps_enabled = true; | |
617 | /* sleep here is must, or we may recv the beacon and | |
618 | * cause mac80211 into wrong ps state, this will cause | |
619 | * power save nullfunc send fail, and further cause | |
620 | * pkt loss, So sleep must quickly but not immediatly | |
621 | * because that will cause nullfunc send by mac80211 | |
622 | * fail, and cause pkt loss, we have tested that 5mA | |
623 | * is worked very well */ | |
3eda95de | 624 | if (!rtlpriv->psc.multi_buffered) |
0baa0fd7 | 625 | queue_delayed_work(rtlpriv->works.rtl_wq, |
f7953b2a LF |
626 | &rtlpriv->works.ps_work, |
627 | MSECS(5)); | |
0baa0fd7 C |
628 | } else { |
629 | rtl_swlps_rf_awake(hw); | |
630 | rtlpriv->psc.sw_ps_enabled = false; | |
631 | } | |
0c817338 LF |
632 | } |
633 | ||
634 | if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) { | |
635 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f30d7507 JP |
636 | "IEEE80211_CONF_CHANGE_RETRY_LIMITS %x\n", |
637 | hw->conf.long_frame_max_tx_count); | |
8d0d43e3 PKS |
638 | /* brought up everything changes (changed == ~0) indicates first |
639 | * open, so use our default value instead of that of wiphy. | |
640 | */ | |
641 | if (changed != ~0) { | |
642 | mac->retry_long = hw->conf.long_frame_max_tx_count; | |
643 | mac->retry_short = hw->conf.long_frame_max_tx_count; | |
644 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RETRY_LIMIT, | |
f7953b2a | 645 | (u8 *)(&hw->conf.long_frame_max_tx_count)); |
8d0d43e3 | 646 | } |
0c817338 LF |
647 | } |
648 | ||
f7953b2a LF |
649 | if (changed & IEEE80211_CONF_CHANGE_CHANNEL && |
650 | !rtlpriv->proximity.proxim_on) { | |
675a0b04 | 651 | struct ieee80211_channel *channel = hw->conf.chandef.chan; |
f7953b2a LF |
652 | enum nl80211_chan_width width = hw->conf.chandef.width; |
653 | enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT; | |
0c817338 LF |
654 | u8 wide_chan = (u8) channel->hw_value; |
655 | ||
f7953b2a LF |
656 | /* channel_type is for 20&40M */ |
657 | if (width < NL80211_CHAN_WIDTH_80) | |
658 | channel_type = | |
659 | cfg80211_get_chandef_type(&hw->conf.chandef); | |
26634c4b LF |
660 | if (mac->act_scanning) |
661 | mac->n_channels++; | |
662 | ||
663 | if (rtlpriv->dm.supp_phymode_switch && | |
f7953b2a LF |
664 | mac->link_state < MAC80211_LINKED && |
665 | !mac->act_scanning) { | |
26634c4b LF |
666 | if (rtlpriv->cfg->ops->chk_switch_dmdp) |
667 | rtlpriv->cfg->ops->chk_switch_dmdp(hw); | |
668 | } | |
669 | ||
0c817338 LF |
670 | /* |
671 | *because we should back channel to | |
672 | *current_network.chan in in scanning, | |
673 | *So if set_chan == current_network.chan | |
674 | *we should set it. | |
675 | *because mac80211 tell us wrong bw40 | |
676 | *info for cisco1253 bw20, so we modify | |
677 | *it here based on UPPER & LOWER | |
678 | */ | |
f7953b2a LF |
679 | |
680 | if (width >= NL80211_CHAN_WIDTH_80) { | |
681 | if (width == NL80211_CHAN_WIDTH_80) { | |
682 | u32 center = hw->conf.chandef.center_freq1; | |
683 | u32 primary = | |
684 | (u32)hw->conf.chandef.chan->center_freq; | |
685 | ||
686 | rtlphy->current_chan_bw = | |
687 | HT_CHANNEL_WIDTH_80; | |
688 | mac->bw_80 = true; | |
689 | mac->bw_40 = true; | |
690 | if (center > primary) { | |
691 | mac->cur_80_prime_sc = | |
692 | PRIME_CHNL_OFFSET_LOWER; | |
693 | if (center - primary == 10) { | |
694 | mac->cur_40_prime_sc = | |
695 | PRIME_CHNL_OFFSET_UPPER; | |
696 | ||
697 | wide_chan += 2; | |
698 | } else if (center - primary == 30) { | |
699 | mac->cur_40_prime_sc = | |
700 | PRIME_CHNL_OFFSET_LOWER; | |
701 | ||
702 | wide_chan += 6; | |
703 | } | |
704 | } else { | |
705 | mac->cur_80_prime_sc = | |
706 | PRIME_CHNL_OFFSET_UPPER; | |
707 | if (primary - center == 10) { | |
708 | mac->cur_40_prime_sc = | |
709 | PRIME_CHNL_OFFSET_LOWER; | |
710 | ||
711 | wide_chan -= 2; | |
712 | } else if (primary - center == 30) { | |
713 | mac->cur_40_prime_sc = | |
714 | PRIME_CHNL_OFFSET_UPPER; | |
715 | ||
716 | wide_chan -= 6; | |
717 | } | |
718 | } | |
719 | } | |
720 | } else { | |
721 | switch (channel_type) { | |
722 | case NL80211_CHAN_HT20: | |
723 | case NL80211_CHAN_NO_HT: | |
724 | /* SC */ | |
725 | mac->cur_40_prime_sc = | |
726 | PRIME_CHNL_OFFSET_DONT_CARE; | |
727 | rtlphy->current_chan_bw = | |
728 | HT_CHANNEL_WIDTH_20; | |
729 | mac->bw_40 = false; | |
730 | mac->bw_80 = false; | |
731 | break; | |
732 | case NL80211_CHAN_HT40MINUS: | |
733 | /* SC */ | |
734 | mac->cur_40_prime_sc = | |
735 | PRIME_CHNL_OFFSET_UPPER; | |
736 | rtlphy->current_chan_bw = | |
737 | HT_CHANNEL_WIDTH_20_40; | |
738 | mac->bw_40 = true; | |
739 | mac->bw_80 = false; | |
740 | ||
741 | /*wide channel */ | |
742 | wide_chan -= 2; | |
743 | ||
744 | break; | |
745 | case NL80211_CHAN_HT40PLUS: | |
746 | /* SC */ | |
747 | mac->cur_40_prime_sc = | |
748 | PRIME_CHNL_OFFSET_LOWER; | |
749 | rtlphy->current_chan_bw = | |
750 | HT_CHANNEL_WIDTH_20_40; | |
751 | mac->bw_40 = true; | |
752 | mac->bw_80 = false; | |
753 | ||
754 | /*wide channel */ | |
755 | wide_chan += 2; | |
756 | ||
757 | break; | |
758 | default: | |
759 | mac->bw_40 = false; | |
760 | mac->bw_80 = false; | |
b03d968b LF |
761 | pr_err("switch case %#x not processed\n", |
762 | channel_type); | |
f7953b2a LF |
763 | break; |
764 | } | |
0c817338 LF |
765 | } |
766 | ||
767 | if (wide_chan <= 0) | |
768 | wide_chan = 1; | |
0baa0fd7 | 769 | |
f7953b2a | 770 | /* In scanning, when before we offchannel we may send a ps=1 |
26634c4b LF |
771 | * null to AP, and then we may send a ps = 0 null to AP quickly, |
772 | * but first null may have caused AP to put lots of packet to | |
773 | * hw tx buffer. These packets must be tx'd before we go off | |
774 | * channel so we must delay more time to let AP flush these | |
775 | * packets before going offchannel, or dis-association or | |
776 | * delete BA will be caused by AP | |
0baa0fd7 | 777 | */ |
9c050440 MM |
778 | if (rtlpriv->mac80211.offchan_delay) { |
779 | rtlpriv->mac80211.offchan_delay = false; | |
0baa0fd7 C |
780 | mdelay(50); |
781 | } | |
f7953b2a | 782 | |
0c817338 LF |
783 | rtlphy->current_channel = wide_chan; |
784 | ||
0c817338 | 785 | rtlpriv->cfg->ops->switch_channel(hw); |
0baa0fd7 | 786 | rtlpriv->cfg->ops->set_channel_access(hw); |
f7953b2a | 787 | rtlpriv->cfg->ops->set_bw_mode(hw, channel_type); |
0c817338 LF |
788 | } |
789 | ||
8a09d6d8 | 790 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
791 | |
792 | return 0; | |
793 | } | |
794 | ||
795 | static void rtl_op_configure_filter(struct ieee80211_hw *hw, | |
f7953b2a LF |
796 | unsigned int changed_flags, |
797 | unsigned int *new_flags, u64 multicast) | |
0c817338 | 798 | { |
99958588 | 799 | bool update_rcr = false; |
0c817338 LF |
800 | struct rtl_priv *rtlpriv = rtl_priv(hw); |
801 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
802 | ||
803 | *new_flags &= RTL_SUPPORTED_FILTERS; | |
f7953b2a | 804 | if (0 == changed_flags) |
0c817338 LF |
805 | return; |
806 | ||
807 | /*TODO: we disable broadcase now, so enable here */ | |
808 | if (changed_flags & FIF_ALLMULTI) { | |
809 | if (*new_flags & FIF_ALLMULTI) { | |
f7953b2a | 810 | mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_AM] | |
0c817338 LF |
811 | rtlpriv->cfg->maps[MAC_RCR_AB]; |
812 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f30d7507 | 813 | "Enable receive multicast frame\n"); |
0c817338 | 814 | } else { |
f7953b2a | 815 | mac->rx_conf &= ~(rtlpriv->cfg->maps[MAC_RCR_AM] | |
0c817338 LF |
816 | rtlpriv->cfg->maps[MAC_RCR_AB]); |
817 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f30d7507 | 818 | "Disable receive multicast frame\n"); |
0c817338 | 819 | } |
99958588 | 820 | update_rcr = true; |
0c817338 LF |
821 | } |
822 | ||
823 | if (changed_flags & FIF_FCSFAIL) { | |
824 | if (*new_flags & FIF_FCSFAIL) { | |
f7953b2a | 825 | mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_ACRC32]; |
0c817338 | 826 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, |
f30d7507 | 827 | "Enable receive FCS error frame\n"); |
0c817338 | 828 | } else { |
f7953b2a | 829 | mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_ACRC32]; |
0c817338 | 830 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, |
f30d7507 | 831 | "Disable receive FCS error frame\n"); |
0c817338 | 832 | } |
99958588 LB |
833 | if (!update_rcr) |
834 | update_rcr = true; | |
0c817338 LF |
835 | } |
836 | ||
f7953b2a LF |
837 | /* if ssid not set to hw don't check bssid |
838 | * here just used for linked scanning, & linked | |
839 | * and nolink check bssid is set in set network_type | |
840 | */ | |
d63589cb FCB |
841 | if (changed_flags & FIF_BCN_PRBRESP_PROMISC && |
842 | mac->link_state >= MAC80211_LINKED) { | |
f7953b2a LF |
843 | if (mac->opmode != NL80211_IFTYPE_AP && |
844 | mac->opmode != NL80211_IFTYPE_MESH_POINT) { | |
845 | if (*new_flags & FIF_BCN_PRBRESP_PROMISC) | |
846 | rtlpriv->cfg->ops->set_chk_bssid(hw, false); | |
847 | else | |
848 | rtlpriv->cfg->ops->set_chk_bssid(hw, true); | |
99958588 LB |
849 | if (update_rcr) |
850 | update_rcr = false; | |
f7953b2a LF |
851 | } |
852 | } | |
0c817338 LF |
853 | |
854 | if (changed_flags & FIF_CONTROL) { | |
855 | if (*new_flags & FIF_CONTROL) { | |
f7953b2a | 856 | mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_ACF]; |
0c817338 LF |
857 | |
858 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f7953b2a | 859 | "Enable receive control frame.\n"); |
0c817338 | 860 | } else { |
f7953b2a | 861 | mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_ACF]; |
0c817338 | 862 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, |
f7953b2a | 863 | "Disable receive control frame.\n"); |
0c817338 | 864 | } |
99958588 LB |
865 | if (!update_rcr) |
866 | update_rcr = true; | |
0c817338 LF |
867 | } |
868 | ||
869 | if (changed_flags & FIF_OTHER_BSS) { | |
870 | if (*new_flags & FIF_OTHER_BSS) { | |
f7953b2a | 871 | mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_AAP]; |
0c817338 | 872 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, |
f7953b2a | 873 | "Enable receive other BSS's frame.\n"); |
0c817338 | 874 | } else { |
f7953b2a | 875 | mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_AAP]; |
0c817338 | 876 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, |
f7953b2a | 877 | "Disable receive other BSS's frame.\n"); |
0c817338 | 878 | } |
99958588 LB |
879 | if (!update_rcr) |
880 | update_rcr = true; | |
0c817338 | 881 | } |
99958588 LB |
882 | |
883 | if (update_rcr) | |
884 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RCR, | |
885 | (u8 *)(&mac->rx_conf)); | |
0c817338 | 886 | } |
b16abaaf | 887 | |
0baa0fd7 C |
888 | static int rtl_op_sta_add(struct ieee80211_hw *hw, |
889 | struct ieee80211_vif *vif, | |
890 | struct ieee80211_sta *sta) | |
891 | { | |
892 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
893 | struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); | |
26634c4b | 894 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); |
0baa0fd7 C |
895 | struct rtl_sta_info *sta_entry; |
896 | ||
897 | if (sta) { | |
f7953b2a | 898 | sta_entry = (struct rtl_sta_info *)sta->drv_priv; |
26634c4b LF |
899 | spin_lock_bh(&rtlpriv->locks.entry_list_lock); |
900 | list_add_tail(&sta_entry->list, &rtlpriv->entry_list); | |
901 | spin_unlock_bh(&rtlpriv->locks.entry_list_lock); | |
0baa0fd7 C |
902 | if (rtlhal->current_bandtype == BAND_ON_2_4G) { |
903 | sta_entry->wireless_mode = WIRELESS_MODE_G; | |
904 | if (sta->supp_rates[0] <= 0xf) | |
905 | sta_entry->wireless_mode = WIRELESS_MODE_B; | |
f7953b2a | 906 | if (sta->ht_cap.ht_supported) |
0baa0fd7 | 907 | sta_entry->wireless_mode = WIRELESS_MODE_N_24G; |
26634c4b LF |
908 | |
909 | if (vif->type == NL80211_IFTYPE_ADHOC) | |
910 | sta_entry->wireless_mode = WIRELESS_MODE_G; | |
0baa0fd7 C |
911 | } else if (rtlhal->current_bandtype == BAND_ON_5G) { |
912 | sta_entry->wireless_mode = WIRELESS_MODE_A; | |
f7953b2a LF |
913 | if (sta->ht_cap.ht_supported) |
914 | sta_entry->wireless_mode = WIRELESS_MODE_N_5G; | |
915 | if (sta->vht_cap.vht_supported) | |
916 | sta_entry->wireless_mode = WIRELESS_MODE_AC_5G; | |
0baa0fd7 | 917 | |
26634c4b LF |
918 | if (vif->type == NL80211_IFTYPE_ADHOC) |
919 | sta_entry->wireless_mode = WIRELESS_MODE_A; | |
920 | } | |
921 | /*disable cck rate for p2p*/ | |
922 | if (mac->p2p) | |
923 | sta->supp_rates[0] &= 0xfffffff0; | |
0c817338 | 924 | |
26634c4b | 925 | memcpy(sta_entry->mac_addr, sta->addr, ETH_ALEN); |
0baa0fd7 | 926 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, |
f7953b2a | 927 | "Add sta addr is %pM\n", sta->addr); |
1d22b177 | 928 | rtlpriv->cfg->ops->update_rate_tbl(hw, sta, 0, true); |
0baa0fd7 | 929 | } |
f7953b2a | 930 | |
0baa0fd7 C |
931 | return 0; |
932 | } | |
26634c4b | 933 | |
0baa0fd7 C |
934 | static int rtl_op_sta_remove(struct ieee80211_hw *hw, |
935 | struct ieee80211_vif *vif, | |
936 | struct ieee80211_sta *sta) | |
937 | { | |
938 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
939 | struct rtl_sta_info *sta_entry; | |
b16abaaf | 940 | |
0baa0fd7 C |
941 | if (sta) { |
942 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, | |
f30d7507 | 943 | "Remove sta addr is %pM\n", sta->addr); |
f7953b2a | 944 | sta_entry = (struct rtl_sta_info *)sta->drv_priv; |
0baa0fd7 C |
945 | sta_entry->wireless_mode = 0; |
946 | sta_entry->ratr_index = 0; | |
26634c4b LF |
947 | spin_lock_bh(&rtlpriv->locks.entry_list_lock); |
948 | list_del(&sta_entry->list); | |
949 | spin_unlock_bh(&rtlpriv->locks.entry_list_lock); | |
0baa0fd7 C |
950 | } |
951 | return 0; | |
952 | } | |
b16abaaf | 953 | |
0c817338 LF |
954 | static int _rtl_get_hal_qnum(u16 queue) |
955 | { | |
956 | int qnum; | |
957 | ||
958 | switch (queue) { | |
959 | case 0: | |
960 | qnum = AC3_VO; | |
961 | break; | |
962 | case 1: | |
963 | qnum = AC2_VI; | |
964 | break; | |
965 | case 2: | |
966 | qnum = AC0_BE; | |
967 | break; | |
968 | case 3: | |
969 | qnum = AC1_BK; | |
970 | break; | |
971 | default: | |
972 | qnum = AC0_BE; | |
973 | break; | |
974 | } | |
975 | return qnum; | |
976 | } | |
977 | ||
978 | /* | |
26634c4b LF |
979 | *for mac80211 VO = 0, VI = 1, BE = 2, BK = 3 |
980 | *for rtl819x BE = 0, BK = 1, VI = 2, VO = 3 | |
0c817338 | 981 | */ |
8a3a3c85 | 982 | static int rtl_op_conf_tx(struct ieee80211_hw *hw, |
f7953b2a LF |
983 | struct ieee80211_vif *vif, u16 queue, |
984 | const struct ieee80211_tx_queue_params *param) | |
0c817338 LF |
985 | { |
986 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
987 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
988 | int aci; | |
989 | ||
990 | if (queue >= AC_MAX) { | |
991 | RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, | |
f30d7507 | 992 | "queue number %d is incorrect!\n", queue); |
0c817338 LF |
993 | return -EINVAL; |
994 | } | |
995 | ||
996 | aci = _rtl_get_hal_qnum(queue); | |
997 | mac->ac[aci].aifs = param->aifs; | |
17c9ac62 LF |
998 | mac->ac[aci].cw_min = cpu_to_le16(param->cw_min); |
999 | mac->ac[aci].cw_max = cpu_to_le16(param->cw_max); | |
1000 | mac->ac[aci].tx_op = cpu_to_le16(param->txop); | |
0c817338 LF |
1001 | memcpy(&mac->edca_param[aci], param, sizeof(*param)); |
1002 | rtlpriv->cfg->ops->set_qos(hw, aci); | |
1003 | return 0; | |
1004 | } | |
1005 | ||
33511b15 TY |
1006 | static void send_beacon_frame(struct ieee80211_hw *hw, |
1007 | struct ieee80211_vif *vif) | |
1008 | { | |
1009 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1010 | struct sk_buff *skb = ieee80211_beacon_get(hw, vif); | |
7c629401 | 1011 | struct rtl_tcb_desc tcb_desc; |
33511b15 | 1012 | |
7c629401 LFDV |
1013 | if (skb) { |
1014 | memset(&tcb_desc, 0, sizeof(struct rtl_tcb_desc)); | |
1015 | rtlpriv->intf_ops->adapter_tx(hw, NULL, skb, &tcb_desc); | |
1016 | } | |
33511b15 TY |
1017 | } |
1018 | ||
0c817338 | 1019 | static void rtl_op_bss_info_changed(struct ieee80211_hw *hw, |
f7953b2a LF |
1020 | struct ieee80211_vif *vif, |
1021 | struct ieee80211_bss_conf *bss_conf, | |
1022 | u32 changed) | |
0c817338 LF |
1023 | { |
1024 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
0baa0fd7 | 1025 | struct rtl_hal *rtlhal = rtl_hal(rtlpriv); |
0c817338 LF |
1026 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); |
1027 | struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); | |
1028 | ||
8a09d6d8 | 1029 | mutex_lock(&rtlpriv->locks.conf_mutex); |
d63589cb FCB |
1030 | if (vif->type == NL80211_IFTYPE_ADHOC || |
1031 | vif->type == NL80211_IFTYPE_AP || | |
1032 | vif->type == NL80211_IFTYPE_MESH_POINT) { | |
1033 | if (changed & BSS_CHANGED_BEACON || | |
0c817338 LF |
1034 | (changed & BSS_CHANGED_BEACON_ENABLED && |
1035 | bss_conf->enable_beacon)) { | |
0c817338 LF |
1036 | if (mac->beacon_enabled == 0) { |
1037 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, | |
f30d7507 | 1038 | "BSS_CHANGED_BEACON_ENABLED\n"); |
0c817338 LF |
1039 | |
1040 | /*start hw beacon interrupt. */ | |
1041 | /*rtlpriv->cfg->ops->set_bcn_reg(hw); */ | |
1042 | mac->beacon_enabled = 1; | |
1043 | rtlpriv->cfg->ops->update_interrupt_mask(hw, | |
1044 | rtlpriv->cfg->maps | |
f7953b2a | 1045 | [RTL_IBSS_INT_MASKS], 0); |
0baa0fd7 C |
1046 | |
1047 | if (rtlpriv->cfg->ops->linked_set_reg) | |
1048 | rtlpriv->cfg->ops->linked_set_reg(hw); | |
33511b15 | 1049 | send_beacon_frame(hw, vif); |
0c817338 | 1050 | } |
0baa0fd7 C |
1051 | } |
1052 | if ((changed & BSS_CHANGED_BEACON_ENABLED && | |
f7953b2a | 1053 | !bss_conf->enable_beacon)) { |
0c817338 LF |
1054 | if (mac->beacon_enabled == 1) { |
1055 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, | |
f30d7507 | 1056 | "ADHOC DISABLE BEACON\n"); |
0c817338 LF |
1057 | |
1058 | mac->beacon_enabled = 0; | |
1059 | rtlpriv->cfg->ops->update_interrupt_mask(hw, 0, | |
1060 | rtlpriv->cfg->maps | |
1061 | [RTL_IBSS_INT_MASKS]); | |
1062 | } | |
1063 | } | |
0c817338 LF |
1064 | if (changed & BSS_CHANGED_BEACON_INT) { |
1065 | RT_TRACE(rtlpriv, COMP_BEACON, DBG_TRACE, | |
f30d7507 | 1066 | "BSS_CHANGED_BEACON_INT\n"); |
0c817338 LF |
1067 | mac->beacon_interval = bss_conf->beacon_int; |
1068 | rtlpriv->cfg->ops->set_bcn_intv(hw); | |
1069 | } | |
1070 | } | |
1071 | ||
1072 | /*TODO: reference to enum ieee80211_bss_change */ | |
1073 | if (changed & BSS_CHANGED_ASSOC) { | |
f7953b2a | 1074 | u8 mstatus; |
b16abaaf | 1075 | |
0c817338 | 1076 | if (bss_conf->assoc) { |
26634c4b | 1077 | struct ieee80211_sta *sta = NULL; |
f7953b2a LF |
1078 | u8 keep_alive = 10; |
1079 | ||
1080 | mstatus = RT_MEDIA_CONNECT; | |
0baa0fd7 C |
1081 | /* we should reset all sec info & cam |
1082 | * before set cam after linked, we should not | |
1083 | * reset in disassoc, that will cause tkip->wep | |
1084 | * fail because some flag will be wrong */ | |
1085 | /* reset sec info */ | |
1086 | rtl_cam_reset_sec_info(hw); | |
1087 | /* reset cam to fix wep fail issue | |
1088 | * when change from wpa to wep */ | |
1089 | rtl_cam_reset_all_entry(hw); | |
1090 | ||
0c817338 LF |
1091 | mac->link_state = MAC80211_LINKED; |
1092 | mac->cnt_after_linked = 0; | |
1093 | mac->assoc_id = bss_conf->aid; | |
d458cdf7 | 1094 | memcpy(mac->bssid, bss_conf->bssid, ETH_ALEN); |
0c817338 | 1095 | |
0baa0fd7 C |
1096 | if (rtlpriv->cfg->ops->linked_set_reg) |
1097 | rtlpriv->cfg->ops->linked_set_reg(hw); | |
f7953b2a | 1098 | |
26634c4b LF |
1099 | rcu_read_lock(); |
1100 | sta = ieee80211_find_sta(vif, (u8 *)bss_conf->bssid); | |
2cddad3c | 1101 | if (!sta) { |
2cddad3c LF |
1102 | rcu_read_unlock(); |
1103 | goto out; | |
1104 | } | |
26634c4b LF |
1105 | RT_TRACE(rtlpriv, COMP_EASY_CONCURRENT, DBG_LOUD, |
1106 | "send PS STATIC frame\n"); | |
1107 | if (rtlpriv->dm.supp_phymode_switch) { | |
1108 | if (sta->ht_cap.ht_supported) | |
1109 | rtl_send_smps_action(hw, sta, | |
f7953b2a | 1110 | IEEE80211_SMPS_STATIC); |
26634c4b | 1111 | } |
f7953b2a LF |
1112 | |
1113 | if (rtlhal->current_bandtype == BAND_ON_5G) { | |
1114 | mac->mode = WIRELESS_MODE_A; | |
1115 | } else { | |
1116 | if (sta->supp_rates[0] <= 0xf) | |
1117 | mac->mode = WIRELESS_MODE_B; | |
1118 | else | |
1119 | mac->mode = WIRELESS_MODE_G; | |
1120 | } | |
1121 | ||
1122 | if (sta->ht_cap.ht_supported) { | |
1123 | if (rtlhal->current_bandtype == BAND_ON_2_4G) | |
1124 | mac->mode = WIRELESS_MODE_N_24G; | |
1125 | else | |
1126 | mac->mode = WIRELESS_MODE_N_5G; | |
1127 | } | |
1128 | ||
1129 | if (sta->vht_cap.vht_supported) { | |
1130 | if (rtlhal->current_bandtype == BAND_ON_5G) | |
1131 | mac->mode = WIRELESS_MODE_AC_5G; | |
1132 | else | |
1133 | mac->mode = WIRELESS_MODE_AC_24G; | |
1134 | } | |
1135 | ||
f898005f | 1136 | if (vif->type == NL80211_IFTYPE_STATION) |
1d22b177 PKS |
1137 | rtlpriv->cfg->ops->update_rate_tbl(hw, sta, 0, |
1138 | true); | |
26634c4b LF |
1139 | rcu_read_unlock(); |
1140 | ||
f7953b2a LF |
1141 | /* to avoid AP Disassociation caused by inactivity */ |
1142 | rtlpriv->cfg->ops->set_hw_reg(hw, | |
1143 | HW_VAR_KEEP_ALIVE, | |
1144 | (u8 *)(&keep_alive)); | |
1145 | ||
0c817338 | 1146 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, |
f30d7507 | 1147 | "BSS_CHANGED_ASSOC\n"); |
0c817338 | 1148 | } else { |
37e89a0e TSL |
1149 | struct cfg80211_bss *bss = NULL; |
1150 | ||
f7953b2a LF |
1151 | mstatus = RT_MEDIA_DISCONNECT; |
1152 | ||
ba9f93f8 LF |
1153 | if (mac->link_state == MAC80211_LINKED) |
1154 | rtl_lps_leave(hw); | |
26634c4b LF |
1155 | if (ppsc->p2p_ps_info.p2p_ps_mode > P2P_PS_NONE) |
1156 | rtl_p2p_ps_cmd(hw, P2P_PS_DISABLE); | |
0c817338 | 1157 | mac->link_state = MAC80211_NOLINK; |
37e89a0e TSL |
1158 | |
1159 | bss = cfg80211_get_bss(hw->wiphy, NULL, | |
1160 | (u8 *)mac->bssid, NULL, 0, | |
1161 | IEEE80211_BSS_TYPE_ESS, | |
1162 | IEEE80211_PRIVACY_OFF); | |
1163 | ||
1164 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, | |
1165 | "bssid = %pMF\n", mac->bssid); | |
1166 | ||
1167 | if (bss) { | |
1168 | cfg80211_unlink_bss(hw->wiphy, bss); | |
1169 | cfg80211_put_bss(hw->wiphy, bss); | |
1170 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, | |
1171 | "cfg80211_unlink !!\n"); | |
1172 | } | |
1173 | ||
93803b33 | 1174 | eth_zero_addr(mac->bssid); |
0baa0fd7 | 1175 | mac->vendor = PEER_UNKNOWN; |
f7953b2a | 1176 | mac->mode = 0; |
0c817338 | 1177 | |
26634c4b LF |
1178 | if (rtlpriv->dm.supp_phymode_switch) { |
1179 | if (rtlpriv->cfg->ops->chk_switch_dmdp) | |
1180 | rtlpriv->cfg->ops->chk_switch_dmdp(hw); | |
1181 | } | |
0c817338 | 1182 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, |
f30d7507 | 1183 | "BSS_CHANGED_UN_ASSOC\n"); |
0c817338 | 1184 | } |
f7953b2a LF |
1185 | rtlpriv->cfg->ops->set_network_type(hw, vif->type); |
1186 | /* For FW LPS: | |
1187 | * To tell firmware we have connected or disconnected | |
1188 | */ | |
1189 | rtlpriv->cfg->ops->set_hw_reg(hw, | |
1190 | HW_VAR_H2C_FW_JOINBSSRPT, | |
1191 | (u8 *)(&mstatus)); | |
1192 | ppsc->report_linked = (mstatus == RT_MEDIA_CONNECT) ? | |
1193 | true : false; | |
1194 | ||
1195 | if (rtlpriv->cfg->ops->get_btc_status()) | |
1196 | rtlpriv->btcoexist.btc_ops->btc_mediastatus_notify( | |
1197 | rtlpriv, mstatus); | |
0c817338 LF |
1198 | } |
1199 | ||
1200 | if (changed & BSS_CHANGED_ERP_CTS_PROT) { | |
1201 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, | |
f30d7507 | 1202 | "BSS_CHANGED_ERP_CTS_PROT\n"); |
0c817338 LF |
1203 | mac->use_cts_protect = bss_conf->use_cts_prot; |
1204 | } | |
1205 | ||
1206 | if (changed & BSS_CHANGED_ERP_PREAMBLE) { | |
1207 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, | |
f30d7507 | 1208 | "BSS_CHANGED_ERP_PREAMBLE use short preamble:%x\n", |
f7953b2a | 1209 | bss_conf->use_short_preamble); |
0c817338 LF |
1210 | |
1211 | mac->short_preamble = bss_conf->use_short_preamble; | |
1212 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_ACK_PREAMBLE, | |
f7953b2a | 1213 | (u8 *)(&mac->short_preamble)); |
0c817338 LF |
1214 | } |
1215 | ||
1216 | if (changed & BSS_CHANGED_ERP_SLOT) { | |
1217 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, | |
f30d7507 | 1218 | "BSS_CHANGED_ERP_SLOT\n"); |
0c817338 LF |
1219 | |
1220 | if (bss_conf->use_short_slot) | |
1221 | mac->slot_time = RTL_SLOT_TIME_9; | |
1222 | else | |
1223 | mac->slot_time = RTL_SLOT_TIME_20; | |
1224 | ||
1225 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SLOT_TIME, | |
f7953b2a | 1226 | (u8 *)(&mac->slot_time)); |
0c817338 LF |
1227 | } |
1228 | ||
1229 | if (changed & BSS_CHANGED_HT) { | |
f7953b2a LF |
1230 | struct ieee80211_sta *sta = NULL; |
1231 | ||
1232 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, | |
1233 | "BSS_CHANGED_HT\n"); | |
1234 | ||
701c2be0 | 1235 | rcu_read_lock(); |
f7953b2a | 1236 | sta = ieee80211_find_sta(vif, (u8 *)bss_conf->bssid); |
0c817338 LF |
1237 | if (sta) { |
1238 | if (sta->ht_cap.ampdu_density > | |
1239 | mac->current_ampdu_density) | |
1240 | mac->current_ampdu_density = | |
1241 | sta->ht_cap.ampdu_density; | |
1242 | if (sta->ht_cap.ampdu_factor < | |
1243 | mac->current_ampdu_factor) | |
1244 | mac->current_ampdu_factor = | |
1245 | sta->ht_cap.ampdu_factor; | |
1246 | } | |
701c2be0 | 1247 | rcu_read_unlock(); |
0c817338 LF |
1248 | |
1249 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SHORTGI_DENSITY, | |
f7953b2a | 1250 | (u8 *)(&mac->max_mss_density)); |
0c817338 LF |
1251 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AMPDU_FACTOR, |
1252 | &mac->current_ampdu_factor); | |
1253 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AMPDU_MIN_SPACE, | |
1254 | &mac->current_ampdu_density); | |
1255 | } | |
1256 | ||
1257 | if (changed & BSS_CHANGED_BSSID) { | |
0c817338 | 1258 | u32 basic_rates; |
f7953b2a | 1259 | struct ieee80211_sta *sta = NULL; |
0c817338 LF |
1260 | |
1261 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BSSID, | |
f7953b2a | 1262 | (u8 *)bss_conf->bssid); |
0c817338 | 1263 | |
f7953b2a LF |
1264 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, |
1265 | "bssid: %pM\n", bss_conf->bssid); | |
0c817338 | 1266 | |
0baa0fd7 | 1267 | mac->vendor = PEER_UNKNOWN; |
d458cdf7 | 1268 | memcpy(mac->bssid, bss_conf->bssid, ETH_ALEN); |
0c817338 | 1269 | |
701c2be0 | 1270 | rcu_read_lock(); |
f7953b2a | 1271 | sta = ieee80211_find_sta(vif, (u8 *)bss_conf->bssid); |
0baa0fd7 C |
1272 | if (!sta) { |
1273 | rcu_read_unlock(); | |
1274 | goto out; | |
1275 | } | |
0c817338 | 1276 | |
0baa0fd7 C |
1277 | if (rtlhal->current_bandtype == BAND_ON_5G) { |
1278 | mac->mode = WIRELESS_MODE_A; | |
1279 | } else { | |
1280 | if (sta->supp_rates[0] <= 0xf) | |
1281 | mac->mode = WIRELESS_MODE_B; | |
1282 | else | |
1283 | mac->mode = WIRELESS_MODE_G; | |
1284 | } | |
1285 | ||
1286 | if (sta->ht_cap.ht_supported) { | |
1287 | if (rtlhal->current_bandtype == BAND_ON_2_4G) | |
0c817338 | 1288 | mac->mode = WIRELESS_MODE_N_24G; |
0baa0fd7 C |
1289 | else |
1290 | mac->mode = WIRELESS_MODE_N_5G; | |
1291 | } | |
0c817338 | 1292 | |
f7953b2a LF |
1293 | if (sta->vht_cap.vht_supported) { |
1294 | if (rtlhal->current_bandtype == BAND_ON_5G) | |
1295 | mac->mode = WIRELESS_MODE_AC_5G; | |
1296 | else | |
1297 | mac->mode = WIRELESS_MODE_AC_24G; | |
1298 | } | |
1299 | ||
0baa0fd7 C |
1300 | /* just station need it, because ibss & ap mode will |
1301 | * set in sta_add, and will be NULL here */ | |
f7953b2a | 1302 | if (vif->type == NL80211_IFTYPE_STATION) { |
0baa0fd7 | 1303 | struct rtl_sta_info *sta_entry; |
b16abaaf | 1304 | |
f7953b2a | 1305 | sta_entry = (struct rtl_sta_info *)sta->drv_priv; |
0baa0fd7 C |
1306 | sta_entry->wireless_mode = mac->mode; |
1307 | } | |
1308 | ||
1309 | if (sta->ht_cap.ht_supported) { | |
1310 | mac->ht_enable = true; | |
1311 | ||
1312 | /* | |
1313 | * for cisco 1252 bw20 it's wrong | |
1314 | * if (ht_cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) { | |
1315 | * mac->bw_40 = true; | |
1316 | * } | |
1317 | * */ | |
0c817338 LF |
1318 | } |
1319 | ||
f7953b2a LF |
1320 | if (sta->vht_cap.vht_supported) |
1321 | mac->vht_enable = true; | |
1322 | ||
0c817338 | 1323 | if (changed & BSS_CHANGED_BASIC_RATES) { |
26634c4b | 1324 | /* for 5G must << RATE_6M_INDEX = 4, |
0baa0fd7 C |
1325 | * because 5G have no cck rate*/ |
1326 | if (rtlhal->current_bandtype == BAND_ON_5G) | |
1327 | basic_rates = sta->supp_rates[1] << 4; | |
0c817338 | 1328 | else |
0baa0fd7 | 1329 | basic_rates = sta->supp_rates[0]; |
0c817338 LF |
1330 | |
1331 | mac->basic_rates = basic_rates; | |
1332 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE, | |
2cddad3c | 1333 | (u8 *)(&basic_rates)); |
0c817338 | 1334 | } |
0baa0fd7 | 1335 | rcu_read_unlock(); |
0c817338 | 1336 | } |
0c817338 | 1337 | out: |
8a09d6d8 | 1338 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
1339 | } |
1340 | ||
37a41b4a | 1341 | static u64 rtl_op_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif) |
0c817338 LF |
1342 | { |
1343 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1344 | u64 tsf; | |
1345 | ||
f7953b2a | 1346 | rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_CORRECT_TSF, (u8 *)(&tsf)); |
0c817338 LF |
1347 | return tsf; |
1348 | } | |
1349 | ||
f7953b2a LF |
1350 | static void rtl_op_set_tsf(struct ieee80211_hw *hw, |
1351 | struct ieee80211_vif *vif, u64 tsf) | |
0c817338 LF |
1352 | { |
1353 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1354 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
6eab04a8 | 1355 | u8 bibss = (mac->opmode == NL80211_IFTYPE_ADHOC) ? 1 : 0; |
0c817338 LF |
1356 | |
1357 | mac->tsf = tsf; | |
f7953b2a | 1358 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_CORRECT_TSF, (u8 *)(&bibss)); |
0c817338 LF |
1359 | } |
1360 | ||
f7953b2a | 1361 | static void rtl_op_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif) |
0c817338 LF |
1362 | { |
1363 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1364 | u8 tmp = 0; | |
1365 | ||
f7953b2a | 1366 | rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_DUAL_TSF_RST, (u8 *)(&tmp)); |
0c817338 LF |
1367 | } |
1368 | ||
1369 | static void rtl_op_sta_notify(struct ieee80211_hw *hw, | |
1370 | struct ieee80211_vif *vif, | |
1371 | enum sta_notify_cmd cmd, | |
1372 | struct ieee80211_sta *sta) | |
1373 | { | |
1374 | switch (cmd) { | |
1375 | case STA_NOTIFY_SLEEP: | |
1376 | break; | |
1377 | case STA_NOTIFY_AWAKE: | |
1378 | break; | |
1379 | default: | |
1380 | break; | |
1381 | } | |
1382 | } | |
1383 | ||
1384 | static int rtl_op_ampdu_action(struct ieee80211_hw *hw, | |
1385 | struct ieee80211_vif *vif, | |
50ea05ef | 1386 | struct ieee80211_ampdu_params *params) |
0c817338 LF |
1387 | { |
1388 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
50ea05ef SS |
1389 | struct ieee80211_sta *sta = params->sta; |
1390 | enum ieee80211_ampdu_mlme_action action = params->action; | |
1391 | u16 tid = params->tid; | |
1392 | u16 *ssn = ¶ms->ssn; | |
0c817338 LF |
1393 | |
1394 | switch (action) { | |
1395 | case IEEE80211_AMPDU_TX_START: | |
1396 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, | |
f30d7507 | 1397 | "IEEE80211_AMPDU_TX_START: TID:%d\n", tid); |
f7953b2a | 1398 | return rtl_tx_agg_start(hw, vif, sta, tid, ssn); |
18b559d5 JB |
1399 | case IEEE80211_AMPDU_TX_STOP_CONT: |
1400 | case IEEE80211_AMPDU_TX_STOP_FLUSH: | |
1401 | case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: | |
0c817338 | 1402 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, |
f30d7507 | 1403 | "IEEE80211_AMPDU_TX_STOP: TID:%d\n", tid); |
f7953b2a | 1404 | return rtl_tx_agg_stop(hw, vif, sta, tid); |
0c817338 LF |
1405 | case IEEE80211_AMPDU_TX_OPERATIONAL: |
1406 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, | |
f30d7507 | 1407 | "IEEE80211_AMPDU_TX_OPERATIONAL:TID:%d\n", tid); |
0baa0fd7 | 1408 | rtl_tx_agg_oper(hw, sta, tid); |
0c817338 LF |
1409 | break; |
1410 | case IEEE80211_AMPDU_RX_START: | |
1411 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, | |
f30d7507 | 1412 | "IEEE80211_AMPDU_RX_START:TID:%d\n", tid); |
26634c4b | 1413 | return rtl_rx_agg_start(hw, sta, tid); |
0c817338 LF |
1414 | case IEEE80211_AMPDU_RX_STOP: |
1415 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, | |
f30d7507 | 1416 | "IEEE80211_AMPDU_RX_STOP:TID:%d\n", tid); |
26634c4b | 1417 | return rtl_rx_agg_stop(hw, sta, tid); |
0c817338 | 1418 | default: |
b03d968b | 1419 | pr_err("IEEE80211_AMPDU_ERR!!!!:\n"); |
0c817338 LF |
1420 | return -EOPNOTSUPP; |
1421 | } | |
1422 | return 0; | |
1423 | } | |
1424 | ||
a344d677 JB |
1425 | static void rtl_op_sw_scan_start(struct ieee80211_hw *hw, |
1426 | struct ieee80211_vif *vif, | |
1427 | const u8 *mac_addr) | |
0c817338 LF |
1428 | { |
1429 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1430 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
1431 | ||
f30d7507 | 1432 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, "\n"); |
26634c4b LF |
1433 | mac->act_scanning = true; |
1434 | if (rtlpriv->link_info.higher_busytraffic) { | |
1435 | mac->skip_scan = true; | |
1436 | return; | |
1437 | } | |
0c817338 | 1438 | |
f7953b2a LF |
1439 | if (rtlpriv->cfg->ops->get_btc_status()) |
1440 | rtlpriv->btcoexist.btc_ops->btc_scan_notify(rtlpriv, 1); | |
9177c336 PKS |
1441 | else if (rtlpriv->btcoexist.btc_ops) |
1442 | rtlpriv->btcoexist.btc_ops->btc_scan_notify_wifi_only(rtlpriv, | |
1443 | 1); | |
f7953b2a | 1444 | |
26634c4b LF |
1445 | if (rtlpriv->dm.supp_phymode_switch) { |
1446 | if (rtlpriv->cfg->ops->chk_switch_dmdp) | |
1447 | rtlpriv->cfg->ops->chk_switch_dmdp(hw); | |
1448 | } | |
f7953b2a | 1449 | |
0c817338 | 1450 | if (mac->link_state == MAC80211_LINKED) { |
ba9f93f8 | 1451 | rtl_lps_leave(hw); |
0c817338 | 1452 | mac->link_state = MAC80211_LINKED_SCANNING; |
0baa0fd7 | 1453 | } else { |
0c817338 | 1454 | rtl_ips_nic_on(hw); |
0baa0fd7 C |
1455 | } |
1456 | ||
f7953b2a | 1457 | /* Dul mac */ |
0baa0fd7 | 1458 | rtlpriv->rtlhal.load_imrandiqk_setting_for2g = false; |
0c817338 LF |
1459 | |
1460 | rtlpriv->cfg->ops->led_control(hw, LED_CTL_SITE_SURVEY); | |
f7953b2a | 1461 | rtlpriv->cfg->ops->scan_operation_backup(hw, SCAN_OPT_BACKUP_BAND0); |
0c817338 LF |
1462 | } |
1463 | ||
a344d677 JB |
1464 | static void rtl_op_sw_scan_complete(struct ieee80211_hw *hw, |
1465 | struct ieee80211_vif *vif) | |
0c817338 LF |
1466 | { |
1467 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1468 | struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); | |
1469 | ||
f30d7507 | 1470 | RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, "\n"); |
0c817338 | 1471 | mac->act_scanning = false; |
26634c4b | 1472 | mac->skip_scan = false; |
c76ab8e7 PKS |
1473 | |
1474 | rtlpriv->btcoexist.btc_info.ap_num = rtlpriv->scan_list.num; | |
1475 | ||
26634c4b LF |
1476 | if (rtlpriv->link_info.higher_busytraffic) |
1477 | return; | |
1478 | ||
f7953b2a | 1479 | /* p2p will use 1/6/11 to scan */ |
26634c4b LF |
1480 | if (mac->n_channels == 3) |
1481 | mac->p2p_in_use = true; | |
1482 | else | |
1483 | mac->p2p_in_use = false; | |
1484 | mac->n_channels = 0; | |
f7953b2a | 1485 | /* Dul mac */ |
0baa0fd7 C |
1486 | rtlpriv->rtlhal.load_imrandiqk_setting_for2g = false; |
1487 | ||
0c817338 LF |
1488 | if (mac->link_state == MAC80211_LINKED_SCANNING) { |
1489 | mac->link_state = MAC80211_LINKED; | |
0baa0fd7 C |
1490 | if (mac->opmode == NL80211_IFTYPE_STATION) { |
1491 | /* fix fwlps issue */ | |
1492 | rtlpriv->cfg->ops->set_network_type(hw, mac->opmode); | |
1493 | } | |
0c817338 LF |
1494 | } |
1495 | ||
0baa0fd7 | 1496 | rtlpriv->cfg->ops->scan_operation_backup(hw, SCAN_OPT_RESTORE); |
f7953b2a LF |
1497 | if (rtlpriv->cfg->ops->get_btc_status()) |
1498 | rtlpriv->btcoexist.btc_ops->btc_scan_notify(rtlpriv, 0); | |
9177c336 PKS |
1499 | else if (rtlpriv->btcoexist.btc_ops) |
1500 | rtlpriv->btcoexist.btc_ops->btc_scan_notify_wifi_only(rtlpriv, | |
1501 | 0); | |
0c817338 LF |
1502 | } |
1503 | ||
1504 | static int rtl_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, | |
1505 | struct ieee80211_vif *vif, struct ieee80211_sta *sta, | |
1506 | struct ieee80211_key_conf *key) | |
1507 | { | |
1508 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
0c817338 LF |
1509 | u8 key_type = NO_ENCRYPTION; |
1510 | u8 key_idx; | |
1511 | bool group_key = false; | |
1512 | bool wep_only = false; | |
1513 | int err = 0; | |
1514 | u8 mac_addr[ETH_ALEN]; | |
1515 | u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; | |
0c817338 | 1516 | |
11f35c95 PKS |
1517 | rtlpriv->btcoexist.btc_info.in_4way = false; |
1518 | ||
0c817338 LF |
1519 | if (rtlpriv->cfg->mod_params->sw_crypto || rtlpriv->sec.use_sw_sec) { |
1520 | RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, | |
f30d7507 | 1521 | "not open hw encryption\n"); |
0c817338 LF |
1522 | return -ENOSPC; /*User disabled HW-crypto */ |
1523 | } | |
26634c4b | 1524 | /* To support IBSS, use sw-crypto for GTK */ |
d63589cb FCB |
1525 | if ((vif->type == NL80211_IFTYPE_ADHOC || |
1526 | vif->type == NL80211_IFTYPE_MESH_POINT) && | |
1527 | !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) | |
26634c4b | 1528 | return -ENOSPC; |
0c817338 | 1529 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, |
f30d7507 | 1530 | "%s hardware based encryption for keyidx: %d, mac: %pM\n", |
f7953b2a LF |
1531 | cmd == SET_KEY ? "Using" : "Disabling", key->keyidx, |
1532 | sta ? sta->addr : bcast_addr); | |
0c817338 LF |
1533 | rtlpriv->sec.being_setkey = true; |
1534 | rtl_ips_nic_on(hw); | |
8a09d6d8 | 1535 | mutex_lock(&rtlpriv->locks.conf_mutex); |
0c817338 | 1536 | /* <1> get encryption alg */ |
0baa0fd7 | 1537 | |
0c817338 LF |
1538 | switch (key->cipher) { |
1539 | case WLAN_CIPHER_SUITE_WEP40: | |
1540 | key_type = WEP40_ENCRYPTION; | |
f30d7507 | 1541 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:WEP40\n"); |
0c817338 LF |
1542 | break; |
1543 | case WLAN_CIPHER_SUITE_WEP104: | |
f30d7507 | 1544 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:WEP104\n"); |
0c817338 | 1545 | key_type = WEP104_ENCRYPTION; |
0c817338 LF |
1546 | break; |
1547 | case WLAN_CIPHER_SUITE_TKIP: | |
1548 | key_type = TKIP_ENCRYPTION; | |
f30d7507 | 1549 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:TKIP\n"); |
0c817338 LF |
1550 | break; |
1551 | case WLAN_CIPHER_SUITE_CCMP: | |
1552 | key_type = AESCCMP_ENCRYPTION; | |
f30d7507 | 1553 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:CCMP\n"); |
0c817338 | 1554 | break; |
26634c4b | 1555 | case WLAN_CIPHER_SUITE_AES_CMAC: |
f7953b2a LF |
1556 | /* HW don't support CMAC encryption, |
1557 | * use software CMAC encryption | |
1558 | */ | |
26634c4b LF |
1559 | key_type = AESCMAC_ENCRYPTION; |
1560 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:CMAC\n"); | |
1561 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, | |
e16e558e | 1562 | "HW don't support CMAC encryption, use software CMAC encryption\n"); |
26634c4b LF |
1563 | err = -EOPNOTSUPP; |
1564 | goto out_unlock; | |
0c817338 | 1565 | default: |
b03d968b | 1566 | pr_err("alg_err:%x!!!!:\n", key->cipher); |
0c817338 LF |
1567 | goto out_unlock; |
1568 | } | |
0baa0fd7 | 1569 | if (key_type == WEP40_ENCRYPTION || |
f7953b2a LF |
1570 | key_type == WEP104_ENCRYPTION || |
1571 | vif->type == NL80211_IFTYPE_ADHOC) | |
0baa0fd7 C |
1572 | rtlpriv->sec.use_defaultkey = true; |
1573 | ||
0c817338 LF |
1574 | /* <2> get key_idx */ |
1575 | key_idx = (u8) (key->keyidx); | |
1576 | if (key_idx > 3) | |
1577 | goto out_unlock; | |
1578 | /* <3> if pairwise key enable_hw_sec */ | |
1579 | group_key = !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE); | |
0baa0fd7 C |
1580 | |
1581 | /* wep always be group key, but there are two conditions: | |
1582 | * 1) wep only: is just for wep enc, in this condition | |
1583 | * rtlpriv->sec.pairwise_enc_algorithm == NO_ENCRYPTION | |
1584 | * will be true & enable_hw_sec will be set when wep | |
f7953b2a | 1585 | * ke setting. |
0baa0fd7 C |
1586 | * 2) wep(group) + AES(pairwise): some AP like cisco |
1587 | * may use it, in this condition enable_hw_sec will not | |
1588 | * be set when wep key setting */ | |
1589 | /* we must reset sec_info after lingked before set key, | |
1590 | * or some flag will be wrong*/ | |
26634c4b | 1591 | if (vif->type == NL80211_IFTYPE_AP || |
f7953b2a | 1592 | vif->type == NL80211_IFTYPE_MESH_POINT) { |
0baa0fd7 C |
1593 | if (!group_key || key_type == WEP40_ENCRYPTION || |
1594 | key_type == WEP104_ENCRYPTION) { | |
1595 | if (group_key) | |
1596 | wep_only = true; | |
1597 | rtlpriv->cfg->ops->enable_hw_sec(hw); | |
1598 | } | |
1599 | } else { | |
d63589cb | 1600 | if (!group_key || vif->type == NL80211_IFTYPE_ADHOC || |
f7953b2a | 1601 | rtlpriv->sec.pairwise_enc_algorithm == NO_ENCRYPTION) { |
0baa0fd7 C |
1602 | if (rtlpriv->sec.pairwise_enc_algorithm == |
1603 | NO_ENCRYPTION && | |
f7953b2a | 1604 | (key_type == WEP40_ENCRYPTION || |
0baa0fd7 C |
1605 | key_type == WEP104_ENCRYPTION)) |
1606 | wep_only = true; | |
1607 | rtlpriv->sec.pairwise_enc_algorithm = key_type; | |
1608 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, | |
f30d7507 JP |
1609 | "set enable_hw_sec, key_type:%x(OPEN:0 WEP40:1 TKIP:2 AES:4 WEP104:5)\n", |
1610 | key_type); | |
0baa0fd7 C |
1611 | rtlpriv->cfg->ops->enable_hw_sec(hw); |
1612 | } | |
0c817338 LF |
1613 | } |
1614 | /* <4> set key based on cmd */ | |
1615 | switch (cmd) { | |
1616 | case SET_KEY: | |
1617 | if (wep_only) { | |
1618 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, | |
f30d7507 | 1619 | "set WEP(group/pairwise) key\n"); |
0c817338 LF |
1620 | /* Pairwise key with an assigned MAC address. */ |
1621 | rtlpriv->sec.pairwise_enc_algorithm = key_type; | |
1622 | rtlpriv->sec.group_enc_algorithm = key_type; | |
1623 | /*set local buf about wep key. */ | |
1624 | memcpy(rtlpriv->sec.key_buf[key_idx], | |
1625 | key->key, key->keylen); | |
1626 | rtlpriv->sec.key_len[key_idx] = key->keylen; | |
ccd95369 | 1627 | eth_zero_addr(mac_addr); |
0c817338 LF |
1628 | } else if (group_key) { /* group key */ |
1629 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, | |
f30d7507 | 1630 | "set group key\n"); |
0c817338 LF |
1631 | /* group key */ |
1632 | rtlpriv->sec.group_enc_algorithm = key_type; | |
1633 | /*set local buf about group key. */ | |
1634 | memcpy(rtlpriv->sec.key_buf[key_idx], | |
1635 | key->key, key->keylen); | |
1636 | rtlpriv->sec.key_len[key_idx] = key->keylen; | |
1637 | memcpy(mac_addr, bcast_addr, ETH_ALEN); | |
1638 | } else { /* pairwise key */ | |
1639 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, | |
f30d7507 | 1640 | "set pairwise key\n"); |
0c817338 | 1641 | if (!sta) { |
531940f9 LF |
1642 | WARN_ONCE(true, |
1643 | "rtlwifi: pairwise key without mac_addr\n"); | |
0baa0fd7 | 1644 | |
0c817338 LF |
1645 | err = -EOPNOTSUPP; |
1646 | goto out_unlock; | |
1647 | } | |
1648 | /* Pairwise key with an assigned MAC address. */ | |
1649 | rtlpriv->sec.pairwise_enc_algorithm = key_type; | |
1650 | /*set local buf about pairwise key. */ | |
1651 | memcpy(rtlpriv->sec.key_buf[PAIRWISE_KEYIDX], | |
1652 | key->key, key->keylen); | |
1653 | rtlpriv->sec.key_len[PAIRWISE_KEYIDX] = key->keylen; | |
1654 | rtlpriv->sec.pairwise_key = | |
1655 | rtlpriv->sec.key_buf[PAIRWISE_KEYIDX]; | |
1656 | memcpy(mac_addr, sta->addr, ETH_ALEN); | |
1657 | } | |
1658 | rtlpriv->cfg->ops->set_key(hw, key_idx, mac_addr, | |
1659 | group_key, key_type, wep_only, | |
1660 | false); | |
1661 | /* <5> tell mac80211 do something: */ | |
1662 | /*must use sw generate IV, or can not work !!!!. */ | |
1663 | key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; | |
1664 | key->hw_key_idx = key_idx; | |
1665 | if (key_type == TKIP_ENCRYPTION) | |
1666 | key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC; | |
26634c4b LF |
1667 | /*use software CCMP encryption for management frames (MFP) */ |
1668 | if (key_type == AESCCMP_ENCRYPTION) | |
1669 | key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; | |
0c817338 LF |
1670 | break; |
1671 | case DISABLE_KEY: | |
1672 | RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, | |
f30d7507 | 1673 | "disable key delete one entry\n"); |
0c817338 | 1674 | /*set local buf about wep key. */ |
26634c4b | 1675 | if (vif->type == NL80211_IFTYPE_AP || |
f7953b2a | 1676 | vif->type == NL80211_IFTYPE_MESH_POINT) { |
0baa0fd7 C |
1677 | if (sta) |
1678 | rtl_cam_del_entry(hw, sta->addr); | |
1679 | } | |
0c817338 LF |
1680 | memset(rtlpriv->sec.key_buf[key_idx], 0, key->keylen); |
1681 | rtlpriv->sec.key_len[key_idx] = 0; | |
ccd95369 | 1682 | eth_zero_addr(mac_addr); |
0c817338 LF |
1683 | /* |
1684 | *mac80211 will delete entrys one by one, | |
1685 | *so don't use rtl_cam_reset_all_entry | |
1686 | *or clear all entry here. | |
1687 | */ | |
8479580b PKS |
1688 | rtl_wait_tx_report_acked(hw, 500); /* wait 500ms for TX ack */ |
1689 | ||
0c817338 LF |
1690 | rtl_cam_delete_one_entry(hw, mac_addr, key_idx); |
1691 | break; | |
1692 | default: | |
b03d968b | 1693 | pr_err("cmd_err:%x!!!!:\n", cmd); |
0c817338 LF |
1694 | } |
1695 | out_unlock: | |
8a09d6d8 | 1696 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
1697 | rtlpriv->sec.being_setkey = false; |
1698 | return err; | |
1699 | } | |
1700 | ||
1701 | static void rtl_op_rfkill_poll(struct ieee80211_hw *hw) | |
1702 | { | |
1703 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1704 | ||
1705 | bool radio_state; | |
1706 | bool blocked; | |
1707 | u8 valid = 0; | |
1708 | ||
1709 | if (!test_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status)) | |
1710 | return; | |
1711 | ||
8a09d6d8 | 1712 | mutex_lock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
1713 | |
1714 | /*if Radio On return true here */ | |
1715 | radio_state = rtlpriv->cfg->ops->radio_onoff_checking(hw, &valid); | |
1716 | ||
1717 | if (valid) { | |
1718 | if (unlikely(radio_state != rtlpriv->rfkill.rfkill_state)) { | |
1719 | rtlpriv->rfkill.rfkill_state = radio_state; | |
1720 | ||
1721 | RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG, | |
f30d7507 | 1722 | "wireless radio switch turned %s\n", |
f7953b2a | 1723 | radio_state ? "on" : "off"); |
0c817338 LF |
1724 | |
1725 | blocked = (rtlpriv->rfkill.rfkill_state == 1) ? 0 : 1; | |
1726 | wiphy_rfkill_set_hw_state(hw->wiphy, blocked); | |
1727 | } | |
1728 | } | |
1729 | ||
8a09d6d8 | 1730 | mutex_unlock(&rtlpriv->locks.conf_mutex); |
0c817338 LF |
1731 | } |
1732 | ||
0baa0fd7 | 1733 | /* this function is called by mac80211 to flush tx buffer |
f7953b2a | 1734 | * before switch channle or power save, or tx buffer packet |
0baa0fd7 C |
1735 | * maybe send after offchannel or rf sleep, this may cause |
1736 | * dis-association by AP */ | |
f7953b2a LF |
1737 | static void rtl_op_flush(struct ieee80211_hw *hw, |
1738 | struct ieee80211_vif *vif, | |
1739 | u32 queues, | |
1740 | bool drop) | |
0baa0fd7 C |
1741 | { |
1742 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1743 | ||
1744 | if (rtlpriv->intf_ops->flush) | |
38506ece | 1745 | rtlpriv->intf_ops->flush(hw, queues, drop); |
0baa0fd7 C |
1746 | } |
1747 | ||
34ed780a LF |
1748 | /* Description: |
1749 | * This routine deals with the Power Configuration CMD | |
1750 | * parsing for RTL8723/RTL8188E Series IC. | |
1751 | * Assumption: | |
1752 | * We should follow specific format that was released from HW SD. | |
1753 | */ | |
1754 | bool rtl_hal_pwrseqcmdparsing(struct rtl_priv *rtlpriv, u8 cut_version, | |
1755 | u8 faversion, u8 interface_type, | |
1756 | struct wlan_pwr_cfg pwrcfgcmd[]) | |
1757 | { | |
f80ead1c | 1758 | struct wlan_pwr_cfg cfg_cmd; |
34ed780a LF |
1759 | bool polling_bit = false; |
1760 | u32 ary_idx = 0; | |
1761 | u8 value = 0; | |
1762 | u32 offset = 0; | |
1763 | u32 polling_count = 0; | |
1764 | u32 max_polling_cnt = 5000; | |
1765 | ||
1766 | do { | |
1767 | cfg_cmd = pwrcfgcmd[ary_idx]; | |
1768 | RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, | |
1769 | "rtl_hal_pwrseqcmdparsing(): offset(%#x),cut_msk(%#x), famsk(%#x), interface_msk(%#x), base(%#x), cmd(%#x), msk(%#x), value(%#x)\n", | |
1770 | GET_PWR_CFG_OFFSET(cfg_cmd), | |
1771 | GET_PWR_CFG_CUT_MASK(cfg_cmd), | |
1772 | GET_PWR_CFG_FAB_MASK(cfg_cmd), | |
1773 | GET_PWR_CFG_INTF_MASK(cfg_cmd), | |
1774 | GET_PWR_CFG_BASE(cfg_cmd), GET_PWR_CFG_CMD(cfg_cmd), | |
1775 | GET_PWR_CFG_MASK(cfg_cmd), GET_PWR_CFG_VALUE(cfg_cmd)); | |
1776 | ||
1777 | if ((GET_PWR_CFG_FAB_MASK(cfg_cmd)&faversion) && | |
1778 | (GET_PWR_CFG_CUT_MASK(cfg_cmd)&cut_version) && | |
1779 | (GET_PWR_CFG_INTF_MASK(cfg_cmd)&interface_type)) { | |
1780 | switch (GET_PWR_CFG_CMD(cfg_cmd)) { | |
1781 | case PWR_CMD_READ: | |
1782 | RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, | |
1783 | "rtl_hal_pwrseqcmdparsing(): PWR_CMD_READ\n"); | |
1784 | break; | |
1785 | case PWR_CMD_WRITE: | |
1786 | RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, | |
634f6b95 | 1787 | "%s(): PWR_CMD_WRITE\n", __func__); |
34ed780a LF |
1788 | offset = GET_PWR_CFG_OFFSET(cfg_cmd); |
1789 | ||
1790 | /*Read the value from system register*/ | |
1791 | value = rtl_read_byte(rtlpriv, offset); | |
1792 | value &= (~(GET_PWR_CFG_MASK(cfg_cmd))); | |
1793 | value |= (GET_PWR_CFG_VALUE(cfg_cmd) & | |
1794 | GET_PWR_CFG_MASK(cfg_cmd)); | |
1795 | ||
1796 | /*Write the value back to sytem register*/ | |
1797 | rtl_write_byte(rtlpriv, offset, value); | |
1798 | break; | |
1799 | case PWR_CMD_POLLING: | |
1800 | RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, | |
1801 | "rtl_hal_pwrseqcmdparsing(): PWR_CMD_POLLING\n"); | |
1802 | polling_bit = false; | |
1803 | offset = GET_PWR_CFG_OFFSET(cfg_cmd); | |
1804 | ||
1805 | do { | |
1806 | value = rtl_read_byte(rtlpriv, offset); | |
1807 | ||
1808 | value &= GET_PWR_CFG_MASK(cfg_cmd); | |
1809 | if (value == | |
1810 | (GET_PWR_CFG_VALUE(cfg_cmd) & | |
1811 | GET_PWR_CFG_MASK(cfg_cmd))) | |
1812 | polling_bit = true; | |
1813 | else | |
1814 | udelay(10); | |
1815 | ||
1816 | if (polling_count++ > max_polling_cnt) | |
1817 | return false; | |
1818 | } while (!polling_bit); | |
1819 | break; | |
1820 | case PWR_CMD_DELAY: | |
1821 | RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, | |
1822 | "rtl_hal_pwrseqcmdparsing(): PWR_CMD_DELAY\n"); | |
1823 | if (GET_PWR_CFG_VALUE(cfg_cmd) == | |
1824 | PWRSEQ_DELAY_US) | |
1825 | udelay(GET_PWR_CFG_OFFSET(cfg_cmd)); | |
1826 | else | |
1827 | mdelay(GET_PWR_CFG_OFFSET(cfg_cmd)); | |
1828 | break; | |
1829 | case PWR_CMD_END: | |
1830 | RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, | |
1831 | "rtl_hal_pwrseqcmdparsing(): PWR_CMD_END\n"); | |
1832 | return true; | |
1833 | default: | |
531940f9 LF |
1834 | WARN_ONCE(true, |
1835 | "rtlwifi: rtl_hal_pwrseqcmdparsing(): Unknown CMD!!\n"); | |
34ed780a LF |
1836 | break; |
1837 | } | |
1838 | } | |
1839 | ary_idx++; | |
1840 | } while (1); | |
1841 | ||
1842 | return true; | |
1843 | } | |
1844 | EXPORT_SYMBOL(rtl_hal_pwrseqcmdparsing); | |
557f9331 LF |
1845 | |
1846 | bool rtl_cmd_send_packet(struct ieee80211_hw *hw, struct sk_buff *skb) | |
1847 | { | |
1848 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1849 | struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); | |
1850 | struct rtl8192_tx_ring *ring; | |
1851 | struct rtl_tx_desc *pdesc; | |
1852 | unsigned long flags; | |
1853 | struct sk_buff *pskb = NULL; | |
1854 | ||
1855 | ring = &rtlpci->tx_ring[BEACON_QUEUE]; | |
1856 | ||
1857 | spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags); | |
1858 | pskb = __skb_dequeue(&ring->queue); | |
22b68b93 LF |
1859 | if (pskb) |
1860 | dev_kfree_skb_irq(pskb); | |
557f9331 LF |
1861 | |
1862 | /*this is wrong, fill_tx_cmddesc needs update*/ | |
1863 | pdesc = &ring->desc[0]; | |
1864 | ||
1865 | rtlpriv->cfg->ops->fill_tx_cmddesc(hw, (u8 *)pdesc, 1, 1, skb); | |
1866 | ||
1867 | __skb_queue_tail(&ring->queue, skb); | |
1868 | ||
1869 | spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags); | |
1870 | ||
1871 | rtlpriv->cfg->ops->tx_polling(hw, BEACON_QUEUE); | |
1872 | ||
1873 | return true; | |
1874 | } | |
1875 | EXPORT_SYMBOL(rtl_cmd_send_packet); | |
0c817338 LF |
1876 | const struct ieee80211_ops rtl_ops = { |
1877 | .start = rtl_op_start, | |
1878 | .stop = rtl_op_stop, | |
1879 | .tx = rtl_op_tx, | |
1880 | .add_interface = rtl_op_add_interface, | |
1881 | .remove_interface = rtl_op_remove_interface, | |
26634c4b | 1882 | .change_interface = rtl_op_change_interface, |
f7953b2a LF |
1883 | #ifdef CONFIG_PM |
1884 | .suspend = rtl_op_suspend, | |
1885 | .resume = rtl_op_resume, | |
1886 | #endif | |
0c817338 LF |
1887 | .config = rtl_op_config, |
1888 | .configure_filter = rtl_op_configure_filter, | |
1889 | .set_key = rtl_op_set_key, | |
1890 | .conf_tx = rtl_op_conf_tx, | |
1891 | .bss_info_changed = rtl_op_bss_info_changed, | |
1892 | .get_tsf = rtl_op_get_tsf, | |
1893 | .set_tsf = rtl_op_set_tsf, | |
1894 | .reset_tsf = rtl_op_reset_tsf, | |
1895 | .sta_notify = rtl_op_sta_notify, | |
1896 | .ampdu_action = rtl_op_ampdu_action, | |
1897 | .sw_scan_start = rtl_op_sw_scan_start, | |
1898 | .sw_scan_complete = rtl_op_sw_scan_complete, | |
1899 | .rfkill_poll = rtl_op_rfkill_poll, | |
f7953b2a LF |
1900 | .sta_add = rtl_op_sta_add, |
1901 | .sta_remove = rtl_op_sta_remove, | |
0baa0fd7 | 1902 | .flush = rtl_op_flush, |
0c817338 | 1903 | }; |
6f334c2b | 1904 | EXPORT_SYMBOL_GPL(rtl_ops); |
c0386f15 LF |
1905 | |
1906 | bool rtl_btc_status_false(void) | |
1907 | { | |
1908 | return false; | |
1909 | } | |
1910 | EXPORT_SYMBOL_GPL(rtl_btc_status_false); | |
6f8214b6 LF |
1911 | |
1912 | void rtl_dm_diginit(struct ieee80211_hw *hw, u32 cur_igvalue) | |
1913 | { | |
1914 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
1915 | struct dig_t *dm_digtable = &rtlpriv->dm_digtable; | |
1916 | ||
1917 | dm_digtable->dig_enable_flag = true; | |
3424a00f | 1918 | dm_digtable->dig_ext_port_stage = DIG_EXT_PORT_STAGE_MAX; |
6f8214b6 LF |
1919 | dm_digtable->cur_igvalue = cur_igvalue; |
1920 | dm_digtable->pre_igvalue = 0; | |
1921 | dm_digtable->cur_sta_cstate = DIG_STA_DISCONNECT; | |
1922 | dm_digtable->presta_cstate = DIG_STA_DISCONNECT; | |
1923 | dm_digtable->curmultista_cstate = DIG_MULTISTA_DISCONNECT; | |
1924 | dm_digtable->rssi_lowthresh = DM_DIG_THRESH_LOW; | |
1925 | dm_digtable->rssi_highthresh = DM_DIG_THRESH_HIGH; | |
1926 | dm_digtable->fa_lowthresh = DM_FALSEALARM_THRESH_LOW; | |
1927 | dm_digtable->fa_highthresh = DM_FALSEALARM_THRESH_HIGH; | |
1928 | dm_digtable->rx_gain_max = DM_DIG_MAX; | |
1929 | dm_digtable->rx_gain_min = DM_DIG_MIN; | |
1930 | dm_digtable->back_val = DM_DIG_BACKOFF_DEFAULT; | |
1931 | dm_digtable->back_range_max = DM_DIG_BACKOFF_MAX; | |
1932 | dm_digtable->back_range_min = DM_DIG_BACKOFF_MIN; | |
1933 | dm_digtable->pre_cck_cca_thres = 0xff; | |
1934 | dm_digtable->cur_cck_cca_thres = 0x83; | |
1935 | dm_digtable->forbidden_igi = DM_DIG_MIN; | |
1936 | dm_digtable->large_fa_hit = 0; | |
1937 | dm_digtable->recover_cnt = 0; | |
1938 | dm_digtable->dig_min_0 = 0x25; | |
1939 | dm_digtable->dig_min_1 = 0x25; | |
1940 | dm_digtable->media_connect_0 = false; | |
1941 | dm_digtable->media_connect_1 = false; | |
1942 | rtlpriv->dm.dm_initialgain_enable = true; | |
1943 | dm_digtable->bt30_cur_igi = 0x32; | |
3424a00f LF |
1944 | dm_digtable->pre_cck_pd_state = CCK_PD_STAGE_MAX; |
1945 | dm_digtable->cur_cck_pd_state = CCK_PD_STAGE_LOWRSSI; | |
5bb5385f BE |
1946 | dm_digtable->pre_cck_fa_state = 0; |
1947 | dm_digtable->cur_cck_fa_state = 0; | |
6f8214b6 LF |
1948 | } |
1949 | EXPORT_SYMBOL(rtl_dm_diginit); |