projects / linux-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
ath5k: fix extra set bit in multicast mask
[linux-block.git] / drivers / net / wireless / rtlwifi / core.c
CommitLineData
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 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
17 *
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
20 *
21 * Contact Information:
22 * wlanfae <wlanfae@realtek.com>
23 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
24 * Hsinchu 300, Taiwan.
25 *
26 * Larry Finger <Larry.Finger@lwfinger.net>
0baa0fd7 27 *
0c817338
LF		 28 *****************************************************************************/
29
30#include "wifi.h"
31#include "core.h"
32#include "cam.h"
33#include "base.h"
b0302aba 34#include "pci.h"
0c817338
LF		 35#include "ps.h"
36
b0302aba
LF		 37#include <linux/export.h>
38
39void rtl_fw_cb(const struct firmware *firmware, void *context)
40{
41 struct ieee80211_hw *hw = context;
42 struct rtl_priv *rtlpriv = rtl_priv(hw);
43 int err;
44
45 RT_TRACE(rtlpriv, COMP_ERR, DBG_LOUD,
46 "Firmware callback routine entered!\n");
47 complete(&rtlpriv->firmware_loading_complete);
48 if (!firmware) {
49 pr_err("Firmware %s not available\n", rtlpriv->cfg->fw_name);
50 rtlpriv->max_fw_size = 0;
51 return;
52 }
53 if (firmware->size > rtlpriv->max_fw_size) {
54 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
55 "Firmware is too big!\n");
56 release_firmware(firmware);
57 return;
58 }
59 memcpy(rtlpriv->rtlhal.pfirmware, firmware->data, firmware->size);
60 rtlpriv->rtlhal.fwsize = firmware->size;
61 release_firmware(firmware);
62
63 err = ieee80211_register_hw(hw);
64 if (err) {
65 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
66 "Can't register mac80211 hw\n");
67 return;
68 } else {
69 rtlpriv->mac80211.mac80211_registered = 1;
70 }
71 set_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status);
72
73 /*init rfkill */
74 rtl_init_rfkill(hw);
75}
76EXPORT_SYMBOL(rtl_fw_cb);
77
0c817338
LF		 78/*mutex for start & stop is must here. */
79static int rtl_op_start(struct ieee80211_hw *hw)
80{
32473284 81 int err;
0c817338
LF		 82 struct rtl_priv *rtlpriv = rtl_priv(hw);
83 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
84
85 if (!is_hal_stop(rtlhal))
86 return 0;
87 if (!test_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status))
88 return 0;
8a09d6d8 89 mutex_lock(&rtlpriv->locks.conf_mutex);
0c817338 90 err = rtlpriv->intf_ops->adapter_start(hw);
32473284
LF		 91 if (!err)
92 rtl_watch_dog_timer_callback((unsigned long)hw);
8a09d6d8 93 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 94 return err;
95}
96
97static void rtl_op_stop(struct ieee80211_hw *hw)
98{
99 struct rtl_priv *rtlpriv = rtl_priv(hw);
100 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
101 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
102 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
103
104 if (is_hal_stop(rtlhal))
105 return;
106
26634c4b
LF		 107 /* here is must, because adhoc do stop and start,
108 * but stop with RFOFF may cause something wrong,
109 * like adhoc TP
110 */
0c817338
LF		 111 if (unlikely(ppsc->rfpwr_state == ERFOFF)) {
112 rtl_ips_nic_on(hw);
0c817338
LF		 113 }
114
8a09d6d8 115 mutex_lock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 116
117 mac->link_state = MAC80211_NOLINK;
118 memset(mac->bssid, 0, 6);
0baa0fd7 119 mac->vendor = PEER_UNKNOWN;
0c817338
LF		 120
121 /*reset sec info */
122 rtl_cam_reset_sec_info(hw);
123
124 rtl_deinit_deferred_work(hw);
125 rtlpriv->intf_ops->adapter_stop(hw);
126
8a09d6d8 127 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 128}
129
36323f81
TH		 130static void rtl_op_tx(struct ieee80211_hw *hw,
131 struct ieee80211_tx_control *control,
132 struct sk_buff *skb)
0c817338
LF		 133{
134 struct rtl_priv *rtlpriv = rtl_priv(hw);
135 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
136 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
0baa0fd7
C		 137 struct rtl_tcb_desc tcb_desc;
138 memset(&tcb_desc, 0, sizeof(struct rtl_tcb_desc));
0c817338
LF		 139
140 if (unlikely(is_hal_stop(rtlhal) || ppsc->rfpwr_state != ERFON))
141 goto err_free;
142
143 if (!test_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status))
144 goto err_free;
145
36323f81
TH		 146 if (!rtlpriv->intf_ops->waitq_insert(hw, control->sta, skb))
147 rtlpriv->intf_ops->adapter_tx(hw, control->sta, skb, &tcb_desc);
0c817338 148
7bb45683 149 return;
0c817338
LF		 150
151err_free:
152 dev_kfree_skb_any(skb);
0c817338
LF		 153}
154
155static int rtl_op_add_interface(struct ieee80211_hw *hw,
156 struct ieee80211_vif *vif)
157{
158 struct rtl_priv *rtlpriv = rtl_priv(hw);
159 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
160 int err = 0;
161
c1288b12
JB		 162 vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER;
163
0c817338
LF		 164 if (mac->vif) {
165 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
f30d7507 166 "vif has been set!! mac->vif = 0x%p\n", mac->vif);
0c817338
LF		 167 return -EOPNOTSUPP;
168 }
169
170 rtl_ips_nic_on(hw);
171
8a09d6d8 172 mutex_lock(&rtlpriv->locks.conf_mutex);
26634c4b
LF		 173
174 switch (ieee80211_vif_type_p2p(vif)) {
175 case NL80211_IFTYPE_P2P_CLIENT:
176 mac->p2p = P2P_ROLE_CLIENT;
177 /*fall through*/
0c817338
LF		 178 case NL80211_IFTYPE_STATION:
179 if (mac->beacon_enabled == 1) {
180 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 181 "NL80211_IFTYPE_STATION\n");
0c817338
LF		 182 mac->beacon_enabled = 0;
183 rtlpriv->cfg->ops->update_interrupt_mask(hw, 0,
184 rtlpriv->cfg->maps
185 [RTL_IBSS_INT_MASKS]);
186 }
187 break;
188 case NL80211_IFTYPE_ADHOC:
189 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 190 "NL80211_IFTYPE_ADHOC\n");
0c817338
LF		 191
192 mac->link_state = MAC80211_LINKED;
193 rtlpriv->cfg->ops->set_bcn_reg(hw);
0baa0fd7
C		 194 if (rtlpriv->rtlhal.current_bandtype == BAND_ON_2_4G)
195 mac->basic_rates = 0xfff;
196 else
197 mac->basic_rates = 0xff0;
198 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE,
199 (u8 *) (&mac->basic_rates));
200
0c817338 201 break;
26634c4b
LF		 202 case NL80211_IFTYPE_P2P_GO:
203 mac->p2p = P2P_ROLE_GO;
204 /*fall through*/
0c817338
LF		 205 case NL80211_IFTYPE_AP:
206 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 207 "NL80211_IFTYPE_AP\n");
0baa0fd7
C		 208
209 mac->link_state = MAC80211_LINKED;
210 rtlpriv->cfg->ops->set_bcn_reg(hw);
211 if (rtlpriv->rtlhal.current_bandtype == BAND_ON_2_4G)
212 mac->basic_rates = 0xfff;
213 else
214 mac->basic_rates = 0xff0;
215 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE,
216 (u8 *) (&mac->basic_rates));
0c817338 217 break;
26634c4b
LF		 218 case NL80211_IFTYPE_MESH_POINT:
219 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
220 "NL80211_IFTYPE_MESH_POINT\n");
221
222 mac->link_state = MAC80211_LINKED;
223 rtlpriv->cfg->ops->set_bcn_reg(hw);
224 if (rtlpriv->rtlhal.current_bandtype == BAND_ON_2_4G)
225 mac->basic_rates = 0xfff;
226 else
227 mac->basic_rates = 0xff0;
228 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE,
229 (u8 *)(&mac->basic_rates));
230 break;
0c817338
LF		 231 default:
232 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
f30d7507 233 "operation mode %d is not supported!\n", vif->type);
0c817338
LF		 234 err = -EOPNOTSUPP;
235 goto out;
236 }
237
26634c4b
LF		 238 if (mac->p2p) {
239 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
240 "p2p role %x\n", vif->type);
241 mac->basic_rates = 0xff0;/*disable cck rate for p2p*/
242 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE,
243 (u8 *)(&mac->basic_rates));
244 }
0c817338
LF		 245 mac->vif = vif;
246 mac->opmode = vif->type;
247 rtlpriv->cfg->ops->set_network_type(hw, vif->type);
248 memcpy(mac->mac_addr, vif->addr, ETH_ALEN);
249 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_ETHER_ADDR, mac->mac_addr);
250
251out:
8a09d6d8 252 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 253 return err;
254}
255
256static void rtl_op_remove_interface(struct ieee80211_hw *hw,
257 struct ieee80211_vif *vif)
258{
259 struct rtl_priv *rtlpriv = rtl_priv(hw);
260 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
261
8a09d6d8 262 mutex_lock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 263
264 /* Free beacon resources */
26634c4b
LF		 265 if ((vif->type == NL80211_IFTYPE_AP) ||
266 (vif->type == NL80211_IFTYPE_ADHOC) ||
267 (vif->type == NL80211_IFTYPE_MESH_POINT)) {
0c817338
LF		 268 if (mac->beacon_enabled == 1) {
269 mac->beacon_enabled = 0;
270 rtlpriv->cfg->ops->update_interrupt_mask(hw, 0,
271 rtlpriv->cfg->maps
272 [RTL_IBSS_INT_MASKS]);
273 }
274 }
275
276 /*
277 *Note: We assume NL80211_IFTYPE_UNSPECIFIED as
278 *NO LINK for our hardware.
279 */
26634c4b 280 mac->p2p = 0;
0c817338
LF		 281 mac->vif = NULL;
282 mac->link_state = MAC80211_NOLINK;
283 memset(mac->bssid, 0, 6);
0baa0fd7 284 mac->vendor = PEER_UNKNOWN;
0c817338
LF		 285 mac->opmode = NL80211_IFTYPE_UNSPECIFIED;
286 rtlpriv->cfg->ops->set_network_type(hw, mac->opmode);
8a09d6d8 287 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 288}
289
26634c4b
LF		 290static int rtl_op_change_interface(struct ieee80211_hw *hw,
291 struct ieee80211_vif *vif,
292 enum nl80211_iftype new_type, bool p2p)
293{
294 struct rtl_priv *rtlpriv = rtl_priv(hw);
295 int ret;
296 rtl_op_remove_interface(hw, vif);
297
298 vif->type = new_type;
299 vif->p2p = p2p;
300 ret = rtl_op_add_interface(hw, vif);
301 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
302 "p2p %x\n", p2p);
303 return ret;
304}
305
0c817338
LF		 306static int rtl_op_config(struct ieee80211_hw *hw, u32 changed)
307{
308 struct rtl_priv *rtlpriv = rtl_priv(hw);
309 struct rtl_phy *rtlphy = &(rtlpriv->phy);
310 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
311 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
312 struct ieee80211_conf *conf = &hw->conf;
313
26634c4b
LF		 314 if (mac->skip_scan)
315 return 1;
316
8a09d6d8 317 mutex_lock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 318 if (changed & IEEE80211_CONF_CHANGE_LISTEN_INTERVAL) { /*BIT(2)*/
319 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 320 "IEEE80211_CONF_CHANGE_LISTEN_INTERVAL\n");
0c817338
LF		 321 }
322
323 /*For IPS */
324 if (changed & IEEE80211_CONF_CHANGE_IDLE) {
325 if (hw->conf.flags & IEEE80211_CONF_IDLE)
326 rtl_ips_nic_off(hw);
327 else
328 rtl_ips_nic_on(hw);
329 } else {
330 /*
331 *although rfoff may not cause by ips, but we will
332 *check the reason in set_rf_power_state function
333 */
334 if (unlikely(ppsc->rfpwr_state == ERFOFF))
335 rtl_ips_nic_on(hw);
336 }
337
338 /*For LPS */
339 if (changed & IEEE80211_CONF_CHANGE_PS) {
0baa0fd7
C		 340 cancel_delayed_work(&rtlpriv->works.ps_work);
341 cancel_delayed_work(&rtlpriv->works.ps_rfon_wq);
342 if (conf->flags & IEEE80211_CONF_PS) {
343 rtlpriv->psc.sw_ps_enabled = true;
344 /* sleep here is must, or we may recv the beacon and
345 * cause mac80211 into wrong ps state, this will cause
346 * power save nullfunc send fail, and further cause
347 * pkt loss, So sleep must quickly but not immediatly
348 * because that will cause nullfunc send by mac80211
349 * fail, and cause pkt loss, we have tested that 5mA
350 * is worked very well */
3eda95de 351 if (!rtlpriv->psc.multi_buffered)
0baa0fd7
C		 352 queue_delayed_work(rtlpriv->works.rtl_wq,
353 &rtlpriv->works.ps_work,
354 MSECS(5));
355 } else {
356 rtl_swlps_rf_awake(hw);
357 rtlpriv->psc.sw_ps_enabled = false;
358 }
0c817338
LF		 359 }
360
361 if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) {
362 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507
JP		 363 "IEEE80211_CONF_CHANGE_RETRY_LIMITS %x\n",
364 hw->conf.long_frame_max_tx_count);
0c817338
LF		 365 mac->retry_long = hw->conf.long_frame_max_tx_count;
366 mac->retry_short = hw->conf.long_frame_max_tx_count;
367 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RETRY_LIMIT,
368 (u8 *) (&hw->conf.
369 long_frame_max_tx_count));
370 }
371
372 if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
675a0b04 373 struct ieee80211_channel *channel = hw->conf.chandef.chan;
0c817338
LF		 374 u8 wide_chan = (u8) channel->hw_value;
375
26634c4b
LF		 376 if (mac->act_scanning)
377 mac->n_channels++;
378
379 if (rtlpriv->dm.supp_phymode_switch &&
380 mac->link_state < MAC80211_LINKED &&
381 !mac->act_scanning) {
382 if (rtlpriv->cfg->ops->chk_switch_dmdp)
383 rtlpriv->cfg->ops->chk_switch_dmdp(hw);
384 }
385
0c817338
LF		 386 /*
387 *because we should back channel to
388 *current_network.chan in in scanning,
389 *So if set_chan == current_network.chan
390 *we should set it.
391 *because mac80211 tell us wrong bw40
392 *info for cisco1253 bw20, so we modify
393 *it here based on UPPER & LOWER
394 */
675a0b04 395 switch (cfg80211_get_chandef_type(&hw->conf.chandef)) {
0c817338
LF		 396 case NL80211_CHAN_HT20:
397 case NL80211_CHAN_NO_HT:
398 /* SC */
399 mac->cur_40_prime_sc =
0baa0fd7 400 PRIME_CHNL_OFFSET_DONT_CARE;
0c817338
LF		 401 rtlphy->current_chan_bw = HT_CHANNEL_WIDTH_20;
402 mac->bw_40 = false;
403 break;
404 case NL80211_CHAN_HT40MINUS:
405 /* SC */
406 mac->cur_40_prime_sc = PRIME_CHNL_OFFSET_UPPER;
407 rtlphy->current_chan_bw =
0baa0fd7 408 HT_CHANNEL_WIDTH_20_40;
0c817338
LF		 409 mac->bw_40 = true;
410
411 /*wide channel */
412 wide_chan -= 2;
413
414 break;
415 case NL80211_CHAN_HT40PLUS:
416 /* SC */
417 mac->cur_40_prime_sc = PRIME_CHNL_OFFSET_LOWER;
418 rtlphy->current_chan_bw =
0baa0fd7 419 HT_CHANNEL_WIDTH_20_40;
0c817338
LF		 420 mac->bw_40 = true;
421
422 /*wide channel */
423 wide_chan += 2;
424
425 break;
426 default:
427 mac->bw_40 = false;
428 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
f30d7507 429 "switch case not processed\n");
0c817338
LF		 430 break;
431 }
432
433 if (wide_chan <= 0)
434 wide_chan = 1;
0baa0fd7 435
26634c4b
LF		 436 /* In scanning, before we go offchannel we may send a ps = 1
437 * null to AP, and then we may send a ps = 0 null to AP quickly,
438 * but first null may have caused AP to put lots of packet to
439 * hw tx buffer. These packets must be tx'd before we go off
440 * channel so we must delay more time to let AP flush these
441 * packets before going offchannel, or dis-association or
442 * delete BA will be caused by AP
0baa0fd7 443 */
9c050440
MM		 444 if (rtlpriv->mac80211.offchan_delay) {
445 rtlpriv->mac80211.offchan_delay = false;
0baa0fd7
C		 446 mdelay(50);
447 }
0c817338
LF		 448 rtlphy->current_channel = wide_chan;
449
0c817338 450 rtlpriv->cfg->ops->switch_channel(hw);
0baa0fd7 451 rtlpriv->cfg->ops->set_channel_access(hw);
0c817338 452 rtlpriv->cfg->ops->set_bw_mode(hw,
675a0b04 453 cfg80211_get_chandef_type(&hw->conf.chandef));
0c817338
LF		 454 }
455
8a09d6d8 456 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 457
458 return 0;
459}
460
461static void rtl_op_configure_filter(struct ieee80211_hw *hw,
462 unsigned int changed_flags,
463 unsigned int *new_flags, u64 multicast)
464{
465 struct rtl_priv *rtlpriv = rtl_priv(hw);
466 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
467
468 *new_flags &= RTL_SUPPORTED_FILTERS;
469 if (!changed_flags)
470 return;
471
472 /*TODO: we disable broadcase now, so enable here */
473 if (changed_flags & FIF_ALLMULTI) {
474 if (*new_flags & FIF_ALLMULTI) {
475 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_AM] |
476 rtlpriv->cfg->maps[MAC_RCR_AB];
477 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 478 "Enable receive multicast frame\n");
0c817338
LF		 479 } else {
480 mac->rx_conf &= ~(rtlpriv->cfg->maps[MAC_RCR_AM] |
481 rtlpriv->cfg->maps[MAC_RCR_AB]);
482 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 483 "Disable receive multicast frame\n");
0c817338
LF		 484 }
485 }
486
487 if (changed_flags & FIF_FCSFAIL) {
488 if (*new_flags & FIF_FCSFAIL) {
489 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_ACRC32];
490 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 491 "Enable receive FCS error frame\n");
0c817338
LF		 492 } else {
493 mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_ACRC32];
494 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 495 "Disable receive FCS error frame\n");
0c817338
LF		 496 }
497 }
498
0baa0fd7
C		 499 /* if ssid not set to hw don't check bssid
500 * here just used for linked scanning, & linked
501 * and nolink check bssid is set in set network_type */
502 if ((changed_flags & FIF_BCN_PRBRESP_PROMISC) &&
503 (mac->link_state >= MAC80211_LINKED)) {
26634c4b
LF		 504 if (mac->opmode != NL80211_IFTYPE_AP &&
505 mac->opmode != NL80211_IFTYPE_MESH_POINT) {
0baa0fd7
C		 506 if (*new_flags & FIF_BCN_PRBRESP_PROMISC) {
507 rtlpriv->cfg->ops->set_chk_bssid(hw, false);
508 } else {
509 rtlpriv->cfg->ops->set_chk_bssid(hw, true);
510 }
511 }
0c817338
LF		 512 }
513
514 if (changed_flags & FIF_CONTROL) {
515 if (*new_flags & FIF_CONTROL) {
516 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_ACF];
0c817338
LF		 517
518 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 519 "Enable receive control frame\n");
0c817338
LF		 520 } else {
521 mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_ACF];
0c817338 522 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 523 "Disable receive control frame\n");
0c817338
LF		 524 }
525 }
526
527 if (changed_flags & FIF_OTHER_BSS) {
528 if (*new_flags & FIF_OTHER_BSS) {
529 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_AAP];
530 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 531 "Enable receive other BSS's frame\n");
0c817338
LF		 532 } else {
533 mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_AAP];
534 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507 535 "Disable receive other BSS's frame\n");
0c817338
LF		 536 }
537 }
0c817338 538}
0baa0fd7
C		 539static int rtl_op_sta_add(struct ieee80211_hw *hw,
540 struct ieee80211_vif *vif,
541 struct ieee80211_sta *sta)
542{
543 struct rtl_priv *rtlpriv = rtl_priv(hw);
544 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
26634c4b 545 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
0baa0fd7
C		 546 struct rtl_sta_info *sta_entry;
547
548 if (sta) {
549 sta_entry = (struct rtl_sta_info *) sta->drv_priv;
26634c4b
LF		 550 spin_lock_bh(&rtlpriv->locks.entry_list_lock);
551 list_add_tail(&sta_entry->list, &rtlpriv->entry_list);
552 spin_unlock_bh(&rtlpriv->locks.entry_list_lock);
0baa0fd7
C		 553 if (rtlhal->current_bandtype == BAND_ON_2_4G) {
554 sta_entry->wireless_mode = WIRELESS_MODE_G;
555 if (sta->supp_rates[0] <= 0xf)
556 sta_entry->wireless_mode = WIRELESS_MODE_B;
26634c4b 557 if (sta->ht_cap.ht_supported == true)
0baa0fd7 558 sta_entry->wireless_mode = WIRELESS_MODE_N_24G;
26634c4b
LF		 559
560 if (vif->type == NL80211_IFTYPE_ADHOC)
561 sta_entry->wireless_mode = WIRELESS_MODE_G;
0baa0fd7
C		 562 } else if (rtlhal->current_bandtype == BAND_ON_5G) {
563 sta_entry->wireless_mode = WIRELESS_MODE_A;
26634c4b 564 if (sta->ht_cap.ht_supported == true)
0baa0fd7 565 sta_entry->wireless_mode = WIRELESS_MODE_N_24G;
0baa0fd7 566
26634c4b
LF		 567 if (vif->type == NL80211_IFTYPE_ADHOC)
568 sta_entry->wireless_mode = WIRELESS_MODE_A;
569 }
570 /*disable cck rate for p2p*/
571 if (mac->p2p)
572 sta->supp_rates[0] &= 0xfffffff0;
0c817338 573
26634c4b 574 memcpy(sta_entry->mac_addr, sta->addr, ETH_ALEN);
0baa0fd7 575 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG,
f30d7507 576 "Add sta addr is %pM\n", sta->addr);
0baa0fd7
C		 577 rtlpriv->cfg->ops->update_rate_tbl(hw, sta, 0);
578 }
579 return 0;
580}
26634c4b 581
0baa0fd7
C		 582static int rtl_op_sta_remove(struct ieee80211_hw *hw,
583 struct ieee80211_vif *vif,
584 struct ieee80211_sta *sta)
585{
586 struct rtl_priv *rtlpriv = rtl_priv(hw);
587 struct rtl_sta_info *sta_entry;
588 if (sta) {
589 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG,
f30d7507 590 "Remove sta addr is %pM\n", sta->addr);
0baa0fd7
C		 591 sta_entry = (struct rtl_sta_info *) sta->drv_priv;
592 sta_entry->wireless_mode = 0;
593 sta_entry->ratr_index = 0;
26634c4b
LF		 594
595 spin_lock_bh(&rtlpriv->locks.entry_list_lock);
596 list_del(&sta_entry->list);
597 spin_unlock_bh(&rtlpriv->locks.entry_list_lock);
0baa0fd7
C		 598 }
599 return 0;
600}
26634c4b 601
0c817338
LF		 602static int _rtl_get_hal_qnum(u16 queue)
603{
604 int qnum;
605
606 switch (queue) {
607 case 0:
608 qnum = AC3_VO;
609 break;
610 case 1:
611 qnum = AC2_VI;
612 break;
613 case 2:
614 qnum = AC0_BE;
615 break;
616 case 3:
617 qnum = AC1_BK;
618 break;
619 default:
620 qnum = AC0_BE;
621 break;
622 }
623 return qnum;
624}
625
626/*
26634c4b
LF		 627 *for mac80211 VO = 0, VI = 1, BE = 2, BK = 3
628 *for rtl819x BE = 0, BK = 1, VI = 2, VO = 3
0c817338 629 */
8a3a3c85
EP		 630static int rtl_op_conf_tx(struct ieee80211_hw *hw,
631 struct ieee80211_vif *vif, u16 queue,
0c817338
LF		 632 const struct ieee80211_tx_queue_params *param)
633{
634 struct rtl_priv *rtlpriv = rtl_priv(hw);
635 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
636 int aci;
637
638 if (queue >= AC_MAX) {
639 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
f30d7507 640 "queue number %d is incorrect!\n", queue);
0c817338
LF		 641 return -EINVAL;
642 }
643
644 aci = _rtl_get_hal_qnum(queue);
645 mac->ac[aci].aifs = param->aifs;
17c9ac62
LF		 646 mac->ac[aci].cw_min = cpu_to_le16(param->cw_min);
647 mac->ac[aci].cw_max = cpu_to_le16(param->cw_max);
648 mac->ac[aci].tx_op = cpu_to_le16(param->txop);
0c817338
LF		 649 memcpy(&mac->edca_param[aci], param, sizeof(*param));
650 rtlpriv->cfg->ops->set_qos(hw, aci);
651 return 0;
652}
653
654static void rtl_op_bss_info_changed(struct ieee80211_hw *hw,
655 struct ieee80211_vif *vif,
656 struct ieee80211_bss_conf *bss_conf, u32 changed)
657{
658 struct rtl_priv *rtlpriv = rtl_priv(hw);
0baa0fd7 659 struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
0c817338
LF		 660 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
661 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
0baa0fd7 662 struct ieee80211_sta *sta = NULL;
0c817338 663
8a09d6d8 664 mutex_lock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 665 if ((vif->type == NL80211_IFTYPE_ADHOC) ||
666 (vif->type == NL80211_IFTYPE_AP) ||
667 (vif->type == NL80211_IFTYPE_MESH_POINT)) {
0c817338
LF		 668 if ((changed & BSS_CHANGED_BEACON) ||
669 (changed & BSS_CHANGED_BEACON_ENABLED &&
670 bss_conf->enable_beacon)) {
0c817338
LF		 671 if (mac->beacon_enabled == 0) {
672 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG,
f30d7507 673 "BSS_CHANGED_BEACON_ENABLED\n");
0c817338
LF		 674
675 /*start hw beacon interrupt. */
676 /*rtlpriv->cfg->ops->set_bcn_reg(hw); */
677 mac->beacon_enabled = 1;
678 rtlpriv->cfg->ops->update_interrupt_mask(hw,
679 rtlpriv->cfg->maps
680 [RTL_IBSS_INT_MASKS],
681 0);
0baa0fd7
C		 682
683 if (rtlpriv->cfg->ops->linked_set_reg)
684 rtlpriv->cfg->ops->linked_set_reg(hw);
0c817338 685 }
0baa0fd7
C		 686 }
687 if ((changed & BSS_CHANGED_BEACON_ENABLED &&
688 !bss_conf->enable_beacon)) {
0c817338
LF		 689 if (mac->beacon_enabled == 1) {
690 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG,
f30d7507 691 "ADHOC DISABLE BEACON\n");
0c817338
LF		 692
693 mac->beacon_enabled = 0;
694 rtlpriv->cfg->ops->update_interrupt_mask(hw, 0,
695 rtlpriv->cfg->maps
696 [RTL_IBSS_INT_MASKS]);
697 }
698 }
0c817338
LF		 699 if (changed & BSS_CHANGED_BEACON_INT) {
700 RT_TRACE(rtlpriv, COMP_BEACON, DBG_TRACE,
f30d7507 701 "BSS_CHANGED_BEACON_INT\n");
0c817338
LF		 702 mac->beacon_interval = bss_conf->beacon_int;
703 rtlpriv->cfg->ops->set_bcn_intv(hw);
704 }
705 }
706
707 /*TODO: reference to enum ieee80211_bss_change */
708 if (changed & BSS_CHANGED_ASSOC) {
709 if (bss_conf->assoc) {
26634c4b 710 struct ieee80211_sta *sta = NULL;
0baa0fd7
C		 711 /* we should reset all sec info & cam
712 * before set cam after linked, we should not
713 * reset in disassoc, that will cause tkip->wep
714 * fail because some flag will be wrong */
715 /* reset sec info */
716 rtl_cam_reset_sec_info(hw);
717 /* reset cam to fix wep fail issue
718 * when change from wpa to wep */
719 rtl_cam_reset_all_entry(hw);
720
0c817338
LF		 721 mac->link_state = MAC80211_LINKED;
722 mac->cnt_after_linked = 0;
723 mac->assoc_id = bss_conf->aid;
724 memcpy(mac->bssid, bss_conf->bssid, 6);
725
0baa0fd7
C		 726 if (rtlpriv->cfg->ops->linked_set_reg)
727 rtlpriv->cfg->ops->linked_set_reg(hw);
26634c4b
LF		 728 rcu_read_lock();
729 sta = ieee80211_find_sta(vif, (u8 *)bss_conf->bssid);
730
731 if (vif->type == NL80211_IFTYPE_STATION && sta)
0baa0fd7 732 rtlpriv->cfg->ops->update_rate_tbl(hw, sta, 0);
26634c4b
LF		 733 RT_TRACE(rtlpriv, COMP_EASY_CONCURRENT, DBG_LOUD,
734 "send PS STATIC frame\n");
735 if (rtlpriv->dm.supp_phymode_switch) {
736 if (sta->ht_cap.ht_supported)
737 rtl_send_smps_action(hw, sta,
738 IEEE80211_SMPS_STATIC);
739 }
740 rcu_read_unlock();
741
0c817338 742 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG,
f30d7507 743 "BSS_CHANGED_ASSOC\n");
0c817338 744 } else {
a269913c
LF		 745 if (mac->link_state == MAC80211_LINKED) {
746 rtlpriv->enter_ps = false;
747 schedule_work(&rtlpriv->works.lps_change_work);
748 }
0c817338 749
26634c4b
LF		 750 if (ppsc->p2p_ps_info.p2p_ps_mode > P2P_PS_NONE)
751 rtl_p2p_ps_cmd(hw, P2P_PS_DISABLE);
0c817338
LF		 752 mac->link_state = MAC80211_NOLINK;
753 memset(mac->bssid, 0, 6);
0baa0fd7 754 mac->vendor = PEER_UNKNOWN;
0c817338 755
26634c4b
LF		 756 if (rtlpriv->dm.supp_phymode_switch) {
757 if (rtlpriv->cfg->ops->chk_switch_dmdp)
758 rtlpriv->cfg->ops->chk_switch_dmdp(hw);
759 }
760
0c817338 761 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG,
f30d7507 762 "BSS_CHANGED_UN_ASSOC\n");
0c817338
LF		 763 }
764 }
765
766 if (changed & BSS_CHANGED_ERP_CTS_PROT) {
767 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE,
f30d7507 768 "BSS_CHANGED_ERP_CTS_PROT\n");
0c817338
LF		 769 mac->use_cts_protect = bss_conf->use_cts_prot;
770 }
771
772 if (changed & BSS_CHANGED_ERP_PREAMBLE) {
773 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD,
f30d7507
JP		 774 "BSS_CHANGED_ERP_PREAMBLE use short preamble:%x\n",
775 bss_conf->use_short_preamble);
0c817338
LF		 776
777 mac->short_preamble = bss_conf->use_short_preamble;
778 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_ACK_PREAMBLE,
2c208890 779 &mac->short_preamble);
0c817338
LF		 780 }
781
782 if (changed & BSS_CHANGED_ERP_SLOT) {
783 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE,
f30d7507 784 "BSS_CHANGED_ERP_SLOT\n");
0c817338
LF		 785
786 if (bss_conf->use_short_slot)
787 mac->slot_time = RTL_SLOT_TIME_9;
788 else
789 mac->slot_time = RTL_SLOT_TIME_20;
790
791 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SLOT_TIME,
2c208890 792 &mac->slot_time);
0c817338
LF		 793 }
794
795 if (changed & BSS_CHANGED_HT) {
f30d7507 796 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, "BSS_CHANGED_HT\n");
701c2be0 797 rcu_read_lock();
7101f404 798 sta = get_sta(hw, vif, bss_conf->bssid);
0c817338
LF		 799 if (sta) {
800 if (sta->ht_cap.ampdu_density >
801 mac->current_ampdu_density)
802 mac->current_ampdu_density =
803 sta->ht_cap.ampdu_density;
804 if (sta->ht_cap.ampdu_factor <
805 mac->current_ampdu_factor)
806 mac->current_ampdu_factor =
807 sta->ht_cap.ampdu_factor;
808 }
701c2be0 809 rcu_read_unlock();
0c817338
LF		 810
811 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SHORTGI_DENSITY,
2c208890 812 &mac->max_mss_density);
0c817338
LF		 813 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AMPDU_FACTOR,
814 &mac->current_ampdu_factor);
815 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AMPDU_MIN_SPACE,
816 &mac->current_ampdu_density);
817 }
818
819 if (changed & BSS_CHANGED_BSSID) {
0c817338 820 u32 basic_rates;
0c817338
LF		 821
822 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BSSID,
823 (u8 *) bss_conf->bssid);
824
f30d7507
JP		 825 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, "%pM\n",
826 bss_conf->bssid);
0c817338 827
0baa0fd7 828 mac->vendor = PEER_UNKNOWN;
0c817338 829 memcpy(mac->bssid, bss_conf->bssid, 6);
0baa0fd7 830 rtlpriv->cfg->ops->set_network_type(hw, vif->type);
0c817338 831
701c2be0 832 rcu_read_lock();
7101f404 833 sta = get_sta(hw, vif, bss_conf->bssid);
0baa0fd7
C		 834 if (!sta) {
835 rcu_read_unlock();
836 goto out;
837 }
0c817338 838
0baa0fd7
C		 839 if (rtlhal->current_bandtype == BAND_ON_5G) {
840 mac->mode = WIRELESS_MODE_A;
841 } else {
842 if (sta->supp_rates[0] <= 0xf)
843 mac->mode = WIRELESS_MODE_B;
844 else
845 mac->mode = WIRELESS_MODE_G;
846 }
847
848 if (sta->ht_cap.ht_supported) {
849 if (rtlhal->current_bandtype == BAND_ON_2_4G)
0c817338 850 mac->mode = WIRELESS_MODE_N_24G;
0baa0fd7
C		 851 else
852 mac->mode = WIRELESS_MODE_N_5G;
853 }
0c817338 854
0baa0fd7
C		 855 /* just station need it, because ibss & ap mode will
856 * set in sta_add, and will be NULL here */
857 if (mac->opmode == NL80211_IFTYPE_STATION) {
858 struct rtl_sta_info *sta_entry;
859 sta_entry = (struct rtl_sta_info *) sta->drv_priv;
860 sta_entry->wireless_mode = mac->mode;
861 }
862
863 if (sta->ht_cap.ht_supported) {
864 mac->ht_enable = true;
865
866 /*
867 * for cisco 1252 bw20 it's wrong
868 * if (ht_cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) {
869 * mac->bw_40 = true;
870 * }
871 * */
0c817338
LF		 872 }
873
0c817338 874 if (changed & BSS_CHANGED_BASIC_RATES) {
26634c4b 875 /* for 5G must << RATE_6M_INDEX = 4,
0baa0fd7
C		 876 * because 5G have no cck rate*/
877 if (rtlhal->current_bandtype == BAND_ON_5G)
878 basic_rates = sta->supp_rates[1] << 4;
0c817338 879 else
0baa0fd7 880 basic_rates = sta->supp_rates[0];
0c817338
LF		 881
882 mac->basic_rates = basic_rates;
883 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE,
884 (u8 *) (&basic_rates));
0c817338 885 }
0baa0fd7 886 rcu_read_unlock();
0c817338
LF		 887 }
888
889 /*
890 * For FW LPS:
891 * To tell firmware we have connected
892 * to an AP. For 92SE/CE power save v2.
893 */
894 if (changed & BSS_CHANGED_ASSOC) {
895 if (bss_conf->assoc) {
7ea47240 896 if (ppsc->fwctrl_lps) {
0c817338
LF		 897 u8 mstatus = RT_MEDIA_CONNECT;
898 rtlpriv->cfg->ops->set_hw_reg(hw,
899 HW_VAR_H2C_FW_JOINBSSRPT,
2c208890 900 &mstatus);
0c817338
LF		 901 ppsc->report_linked = true;
902 }
903 } else {
7ea47240 904 if (ppsc->fwctrl_lps) {
0c817338
LF		 905 u8 mstatus = RT_MEDIA_DISCONNECT;
906 rtlpriv->cfg->ops->set_hw_reg(hw,
907 HW_VAR_H2C_FW_JOINBSSRPT,
2c208890 908 &mstatus);
0c817338
LF		 909 ppsc->report_linked = false;
910 }
911 }
26634c4b
LF		 912 if (rtlpriv->cfg->ops->bt_wifi_media_status_notify)
913 rtlpriv->cfg->ops->bt_wifi_media_status_notify(hw,
914 ppsc->report_linked);
0c817338
LF		 915 }
916
917out:
8a09d6d8 918 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 919}
920
37a41b4a 921static u64 rtl_op_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
0c817338
LF		 922{
923 struct rtl_priv *rtlpriv = rtl_priv(hw);
924 u64 tsf;
925
926 rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_CORRECT_TSF, (u8 *) (&tsf));
927 return tsf;
928}
929
37a41b4a
EP		 930static void rtl_op_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
931 u64 tsf)
0c817338
LF		 932{
933 struct rtl_priv *rtlpriv = rtl_priv(hw);
934 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
6eab04a8 935 u8 bibss = (mac->opmode == NL80211_IFTYPE_ADHOC) ? 1 : 0;
0c817338
LF		 936
937 mac->tsf = tsf;
2c208890 938 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_CORRECT_TSF, &bibss);
0c817338
LF		 939}
940
37a41b4a
EP		 941static void rtl_op_reset_tsf(struct ieee80211_hw *hw,
942 struct ieee80211_vif *vif)
0c817338
LF		 943{
944 struct rtl_priv *rtlpriv = rtl_priv(hw);
945 u8 tmp = 0;
946
2c208890 947 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_DUAL_TSF_RST, &tmp);
0c817338
LF		 948}
949
950static void rtl_op_sta_notify(struct ieee80211_hw *hw,
951 struct ieee80211_vif *vif,
952 enum sta_notify_cmd cmd,
953 struct ieee80211_sta *sta)
954{
955 switch (cmd) {
956 case STA_NOTIFY_SLEEP:
957 break;
958 case STA_NOTIFY_AWAKE:
959 break;
960 default:
961 break;
962 }
963}
964
965static int rtl_op_ampdu_action(struct ieee80211_hw *hw,
966 struct ieee80211_vif *vif,
967 enum ieee80211_ampdu_mlme_action action,
0b01f030
JB		 968 struct ieee80211_sta *sta, u16 tid, u16 *ssn,
969 u8 buf_size)
0c817338
LF		 970{
971 struct rtl_priv *rtlpriv = rtl_priv(hw);
972
973 switch (action) {
974 case IEEE80211_AMPDU_TX_START:
975 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE,
f30d7507 976 "IEEE80211_AMPDU_TX_START: TID:%d\n", tid);
0baa0fd7 977 return rtl_tx_agg_start(hw, sta, tid, ssn);
0c817338 978 break;
18b559d5
JB		 979 case IEEE80211_AMPDU_TX_STOP_CONT:
980 case IEEE80211_AMPDU_TX_STOP_FLUSH:
981 case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT:
0c817338 982 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE,
f30d7507 983 "IEEE80211_AMPDU_TX_STOP: TID:%d\n", tid);
0baa0fd7 984 return rtl_tx_agg_stop(hw, sta, tid);
0c817338
LF		 985 case IEEE80211_AMPDU_TX_OPERATIONAL:
986 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE,
f30d7507 987 "IEEE80211_AMPDU_TX_OPERATIONAL:TID:%d\n", tid);
0baa0fd7 988 rtl_tx_agg_oper(hw, sta, tid);
0c817338
LF		 989 break;
990 case IEEE80211_AMPDU_RX_START:
991 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE,
f30d7507 992 "IEEE80211_AMPDU_RX_START:TID:%d\n", tid);
26634c4b 993 return rtl_rx_agg_start(hw, sta, tid);
0c817338
LF		 994 case IEEE80211_AMPDU_RX_STOP:
995 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE,
f30d7507 996 "IEEE80211_AMPDU_RX_STOP:TID:%d\n", tid);
26634c4b 997 return rtl_rx_agg_stop(hw, sta, tid);
0c817338
LF		 998 default:
999 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
f30d7507 1000 "IEEE80211_AMPDU_ERR!!!!:\n");
0c817338
LF		 1001 return -EOPNOTSUPP;
1002 }
1003 return 0;
1004}
1005
1006static void rtl_op_sw_scan_start(struct ieee80211_hw *hw)
1007{
1008 struct rtl_priv *rtlpriv = rtl_priv(hw);
1009 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
1010
f30d7507 1011 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, "\n");
26634c4b
LF		 1012 mac->act_scanning = true;
1013 if (rtlpriv->link_info.higher_busytraffic) {
1014 mac->skip_scan = true;
1015 return;
1016 }
0c817338 1017
26634c4b
LF		 1018 if (rtlpriv->dm.supp_phymode_switch) {
1019 if (rtlpriv->cfg->ops->chk_switch_dmdp)
1020 rtlpriv->cfg->ops->chk_switch_dmdp(hw);
1021 }
0c817338 1022 if (mac->link_state == MAC80211_LINKED) {
a269913c
LF		 1023 rtlpriv->enter_ps = false;
1024 schedule_work(&rtlpriv->works.lps_change_work);
0c817338 1025 mac->link_state = MAC80211_LINKED_SCANNING;
0baa0fd7 1026 } else {
0c817338 1027 rtl_ips_nic_on(hw);
0baa0fd7
C		 1028 }
1029
1030 /* Dual mac */
1031 rtlpriv->rtlhal.load_imrandiqk_setting_for2g = false;
0c817338
LF		 1032
1033 rtlpriv->cfg->ops->led_control(hw, LED_CTL_SITE_SURVEY);
1034 rtlpriv->cfg->ops->scan_operation_backup(hw, SCAN_OPT_BACKUP);
1035}
1036
1037static void rtl_op_sw_scan_complete(struct ieee80211_hw *hw)
1038{
1039 struct rtl_priv *rtlpriv = rtl_priv(hw);
1040 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
1041
f30d7507 1042 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, "\n");
0c817338 1043 mac->act_scanning = false;
26634c4b
LF		 1044 mac->skip_scan = false;
1045 if (rtlpriv->link_info.higher_busytraffic)
1046 return;
1047
1048 /*p2p will use 1/6/11 to scan */
1049 if (mac->n_channels == 3)
1050 mac->p2p_in_use = true;
1051 else
1052 mac->p2p_in_use = false;
1053 mac->n_channels = 0;
0baa0fd7
C		 1054 /* Dual mac */
1055 rtlpriv->rtlhal.load_imrandiqk_setting_for2g = false;
1056
0c817338
LF		 1057 if (mac->link_state == MAC80211_LINKED_SCANNING) {
1058 mac->link_state = MAC80211_LINKED;
0baa0fd7
C		 1059 if (mac->opmode == NL80211_IFTYPE_STATION) {
1060 /* fix fwlps issue */
1061 rtlpriv->cfg->ops->set_network_type(hw, mac->opmode);
1062 }
0c817338
LF		 1063 }
1064
0baa0fd7 1065 rtlpriv->cfg->ops->scan_operation_backup(hw, SCAN_OPT_RESTORE);
0c817338
LF		 1066}
1067
1068static int rtl_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
1069 struct ieee80211_vif *vif, struct ieee80211_sta *sta,
1070 struct ieee80211_key_conf *key)
1071{
1072 struct rtl_priv *rtlpriv = rtl_priv(hw);
1073 struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
1074 u8 key_type = NO_ENCRYPTION;
1075 u8 key_idx;
1076 bool group_key = false;
1077 bool wep_only = false;
1078 int err = 0;
1079 u8 mac_addr[ETH_ALEN];
1080 u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
0c817338
LF		 1081
1082 if (rtlpriv->cfg->mod_params->sw_crypto || rtlpriv->sec.use_sw_sec) {
1083 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
f30d7507 1084 "not open hw encryption\n");
0c817338
LF		 1085 return -ENOSPC; /*User disabled HW-crypto */
1086 }
26634c4b
LF		 1087 /* To support IBSS, use sw-crypto for GTK */
1088 if (((vif->type == NL80211_IFTYPE_ADHOC) ||
1089 (vif->type == NL80211_IFTYPE_MESH_POINT)) &&
1090 !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE))
1091 return -ENOSPC;
0c817338 1092 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
f30d7507
JP		 1093 "%s hardware based encryption for keyidx: %d, mac: %pM\n",
1094 cmd == SET_KEY ? "Using" : "Disabling", key->keyidx,
1095 sta ? sta->addr : bcast_addr);
0c817338
LF		 1096 rtlpriv->sec.being_setkey = true;
1097 rtl_ips_nic_on(hw);
8a09d6d8 1098 mutex_lock(&rtlpriv->locks.conf_mutex);
0c817338 1099 /* <1> get encryption alg */
0baa0fd7 1100
0c817338
LF		 1101 switch (key->cipher) {
1102 case WLAN_CIPHER_SUITE_WEP40:
1103 key_type = WEP40_ENCRYPTION;
f30d7507 1104 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:WEP40\n");
0c817338
LF		 1105 break;
1106 case WLAN_CIPHER_SUITE_WEP104:
f30d7507 1107 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:WEP104\n");
0c817338 1108 key_type = WEP104_ENCRYPTION;
0c817338
LF		 1109 break;
1110 case WLAN_CIPHER_SUITE_TKIP:
1111 key_type = TKIP_ENCRYPTION;
f30d7507 1112 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:TKIP\n");
0c817338
LF		 1113 break;
1114 case WLAN_CIPHER_SUITE_CCMP:
1115 key_type = AESCCMP_ENCRYPTION;
f30d7507 1116 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:CCMP\n");
0c817338 1117 break;
26634c4b
LF		 1118 case WLAN_CIPHER_SUITE_AES_CMAC:
1119 /*HW doesn't support CMAC encryption, use software CMAC */
1120 key_type = AESCMAC_ENCRYPTION;
1121 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:CMAC\n");
1122 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
1123 "HW don't support CMAC encryption, use software CMAC\n");
1124 err = -EOPNOTSUPP;
1125 goto out_unlock;
0c817338 1126 default:
f30d7507
JP		 1127 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, "alg_err:%x!!!!\n",
1128 key->cipher);
0c817338
LF		 1129 goto out_unlock;
1130 }
0baa0fd7
C		 1131 if (key_type == WEP40_ENCRYPTION ||
1132 key_type == WEP104_ENCRYPTION ||
1133 mac->opmode == NL80211_IFTYPE_ADHOC)
1134 rtlpriv->sec.use_defaultkey = true;
1135
0c817338
LF		 1136 /* <2> get key_idx */
1137 key_idx = (u8) (key->keyidx);
1138 if (key_idx > 3)
1139 goto out_unlock;
1140 /* <3> if pairwise key enable_hw_sec */
1141 group_key = !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE);
0baa0fd7
C		 1142
1143 /* wep always be group key, but there are two conditions:
1144 * 1) wep only: is just for wep enc, in this condition
1145 * rtlpriv->sec.pairwise_enc_algorithm == NO_ENCRYPTION
1146 * will be true & enable_hw_sec will be set when wep
26634c4b 1147 * key setting.
0baa0fd7
C		 1148 * 2) wep(group) + AES(pairwise): some AP like cisco
1149 * may use it, in this condition enable_hw_sec will not
1150 * be set when wep key setting */
1151 /* we must reset sec_info after lingked before set key,
1152 * or some flag will be wrong*/
26634c4b
LF		 1153 if (vif->type == NL80211_IFTYPE_AP ||
1154 vif->type == NL80211_IFTYPE_MESH_POINT) {
0baa0fd7
C		 1155 if (!group_key || key_type == WEP40_ENCRYPTION ||
1156 key_type == WEP104_ENCRYPTION) {
1157 if (group_key)
1158 wep_only = true;
1159 rtlpriv->cfg->ops->enable_hw_sec(hw);
1160 }
1161 } else {
1162 if ((!group_key) || (mac->opmode == NL80211_IFTYPE_ADHOC) ||
1163 rtlpriv->sec.pairwise_enc_algorithm == NO_ENCRYPTION) {
1164 if (rtlpriv->sec.pairwise_enc_algorithm ==
1165 NO_ENCRYPTION &&
1166 (key_type == WEP40_ENCRYPTION ||
1167 key_type == WEP104_ENCRYPTION))
1168 wep_only = true;
1169 rtlpriv->sec.pairwise_enc_algorithm = key_type;
1170 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
f30d7507
JP		 1171 "set enable_hw_sec, key_type:%x(OPEN:0 WEP40:1 TKIP:2 AES:4 WEP104:5)\n",
1172 key_type);
0baa0fd7
C		 1173 rtlpriv->cfg->ops->enable_hw_sec(hw);
1174 }
0c817338
LF		 1175 }
1176 /* <4> set key based on cmd */
1177 switch (cmd) {
1178 case SET_KEY:
1179 if (wep_only) {
1180 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
f30d7507 1181 "set WEP(group/pairwise) key\n");
0c817338
LF		 1182 /* Pairwise key with an assigned MAC address. */
1183 rtlpriv->sec.pairwise_enc_algorithm = key_type;
1184 rtlpriv->sec.group_enc_algorithm = key_type;
1185 /*set local buf about wep key. */
1186 memcpy(rtlpriv->sec.key_buf[key_idx],
1187 key->key, key->keylen);
1188 rtlpriv->sec.key_len[key_idx] = key->keylen;
ccd95369 1189 eth_zero_addr(mac_addr);
0c817338
LF		 1190 } else if (group_key) { /* group key */
1191 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
f30d7507 1192 "set group key\n");
0c817338
LF		 1193 /* group key */
1194 rtlpriv->sec.group_enc_algorithm = key_type;
1195 /*set local buf about group key. */
1196 memcpy(rtlpriv->sec.key_buf[key_idx],
1197 key->key, key->keylen);
1198 rtlpriv->sec.key_len[key_idx] = key->keylen;
1199 memcpy(mac_addr, bcast_addr, ETH_ALEN);
1200 } else { /* pairwise key */
1201 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
f30d7507 1202 "set pairwise key\n");
0c817338 1203 if (!sta) {
9d833ed7
JP		 1204 RT_ASSERT(false,
1205 "pairwise key without mac_addr\n");
0baa0fd7 1206
0c817338
LF		 1207 err = -EOPNOTSUPP;
1208 goto out_unlock;
1209 }
1210 /* Pairwise key with an assigned MAC address. */
1211 rtlpriv->sec.pairwise_enc_algorithm = key_type;
1212 /*set local buf about pairwise key. */
1213 memcpy(rtlpriv->sec.key_buf[PAIRWISE_KEYIDX],
1214 key->key, key->keylen);
1215 rtlpriv->sec.key_len[PAIRWISE_KEYIDX] = key->keylen;
1216 rtlpriv->sec.pairwise_key =
1217 rtlpriv->sec.key_buf[PAIRWISE_KEYIDX];
1218 memcpy(mac_addr, sta->addr, ETH_ALEN);
1219 }
1220 rtlpriv->cfg->ops->set_key(hw, key_idx, mac_addr,
1221 group_key, key_type, wep_only,
1222 false);
1223 /* <5> tell mac80211 do something: */
1224 /*must use sw generate IV, or can not work !!!!. */
1225 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
1226 key->hw_key_idx = key_idx;
1227 if (key_type == TKIP_ENCRYPTION)
1228 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
26634c4b
LF		 1229 /*use software CCMP encryption for management frames (MFP) */
1230 if (key_type == AESCCMP_ENCRYPTION)
1231 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
0c817338
LF		 1232 break;
1233 case DISABLE_KEY:
1234 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG,
f30d7507 1235 "disable key delete one entry\n");
0c817338 1236 /*set local buf about wep key. */
26634c4b
LF		 1237 if (vif->type == NL80211_IFTYPE_AP ||
1238 vif->type == NL80211_IFTYPE_MESH_POINT) {
0baa0fd7
C		 1239 if (sta)
1240 rtl_cam_del_entry(hw, sta->addr);
1241 }
0c817338
LF		 1242 memset(rtlpriv->sec.key_buf[key_idx], 0, key->keylen);
1243 rtlpriv->sec.key_len[key_idx] = 0;
ccd95369 1244 eth_zero_addr(mac_addr);
0c817338
LF		 1245 /*
1246 *mac80211 will delete entrys one by one,
1247 *so don't use rtl_cam_reset_all_entry
1248 *or clear all entry here.
1249 */
1250 rtl_cam_delete_one_entry(hw, mac_addr, key_idx);
bac2555c
G		 1251
1252 rtl_cam_reset_sec_info(hw);
1253
0c817338
LF		 1254 break;
1255 default:
1256 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG,
f30d7507 1257 "cmd_err:%x!!!!\n", cmd);
0c817338
LF		 1258 }
1259out_unlock:
8a09d6d8 1260 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 1261 rtlpriv->sec.being_setkey = false;
1262 return err;
1263}
1264
1265static void rtl_op_rfkill_poll(struct ieee80211_hw *hw)
1266{
1267 struct rtl_priv *rtlpriv = rtl_priv(hw);
1268
1269 bool radio_state;
1270 bool blocked;
1271 u8 valid = 0;
1272
1273 if (!test_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status))
1274 return;
1275
8a09d6d8 1276 mutex_lock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 1277
1278 /*if Radio On return true here */
1279 radio_state = rtlpriv->cfg->ops->radio_onoff_checking(hw, &valid);
1280
1281 if (valid) {
1282 if (unlikely(radio_state != rtlpriv->rfkill.rfkill_state)) {
1283 rtlpriv->rfkill.rfkill_state = radio_state;
1284
1285 RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG,
f30d7507
JP		 1286 "wireless radio switch turned %s\n",
1287 radio_state ? "on" : "off");
0c817338
LF		 1288
1289 blocked = (rtlpriv->rfkill.rfkill_state == 1) ? 0 : 1;
1290 wiphy_rfkill_set_hw_state(hw->wiphy, blocked);
1291 }
1292 }
1293
8a09d6d8 1294 mutex_unlock(&rtlpriv->locks.conf_mutex);
0c817338
LF		 1295}
1296
0baa0fd7 1297/* this function is called by mac80211 to flush tx buffer
26634c4b 1298 * before switch channel or power save, or tx buffer packet
0baa0fd7
C		 1299 * maybe send after offchannel or rf sleep, this may cause
1300 * dis-association by AP */
39ecc01d 1301static void rtl_op_flush(struct ieee80211_hw *hw, u32 queues, bool drop)
0baa0fd7
C		 1302{
1303 struct rtl_priv *rtlpriv = rtl_priv(hw);
1304
1305 if (rtlpriv->intf_ops->flush)
1306 rtlpriv->intf_ops->flush(hw, drop);
1307}
1308
0c817338
LF		 1309const struct ieee80211_ops rtl_ops = {
1310 .start = rtl_op_start,
1311 .stop = rtl_op_stop,
1312 .tx = rtl_op_tx,
1313 .add_interface = rtl_op_add_interface,
1314 .remove_interface = rtl_op_remove_interface,
26634c4b 1315 .change_interface = rtl_op_change_interface,
0c817338
LF		 1316 .config = rtl_op_config,
1317 .configure_filter = rtl_op_configure_filter,
0baa0fd7
C		 1318 .sta_add = rtl_op_sta_add,
1319 .sta_remove = rtl_op_sta_remove,
0c817338
LF		 1320 .set_key = rtl_op_set_key,
1321 .conf_tx = rtl_op_conf_tx,
1322 .bss_info_changed = rtl_op_bss_info_changed,
1323 .get_tsf = rtl_op_get_tsf,
1324 .set_tsf = rtl_op_set_tsf,
1325 .reset_tsf = rtl_op_reset_tsf,
1326 .sta_notify = rtl_op_sta_notify,
1327 .ampdu_action = rtl_op_ampdu_action,
1328 .sw_scan_start = rtl_op_sw_scan_start,
1329 .sw_scan_complete = rtl_op_sw_scan_complete,
1330 .rfkill_poll = rtl_op_rfkill_poll,
0baa0fd7 1331 .flush = rtl_op_flush,
0c817338 1332};
Linux 6.x block layer and io_uring tree(s)