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