1 /****************************************************************************** 2 * 3 * Copyright(c) 2009-2012 Realtek Corporation. 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 * 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> 23 * 24 *****************************************************************************/ 25 26 #include "wifi.h" 27 #include "core.h" 28 #include "cam.h" 29 #include "base.h" 30 #include "ps.h" 31 #include "pwrseqcmd.h" 32 33 #include "btcoexist/rtl_btc.h" 34 #include <linux/firmware.h> 35 #include <linux/export.h> 36 #include <net/cfg80211.h> 37 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 54 void rtl_addr_delay(u32 addr) 55 { 56 if (addr == 0xfe) 57 mdelay(50); 58 else if (addr == 0xfd) 59 msleep(5); 60 else if (addr == 0xfc) 61 msleep(1); 62 else if (addr == 0xfb) 63 usleep_range(50, 100); 64 else if (addr == 0xfa) 65 usleep_range(5, 10); 66 else if (addr == 0xf9) 67 usleep_range(1, 2); 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 { 74 if (addr >= 0xf9 && addr <= 0xfe) { 75 rtl_addr_delay(addr); 76 } else { 77 rtl_set_rfreg(hw, rfpath, addr, mask, data); 78 udelay(1); 79 } 80 } 81 EXPORT_SYMBOL(rtl_rfreg_delay); 82 83 void rtl_bb_delay(struct ieee80211_hw *hw, u32 addr, u32 data) 84 { 85 if (addr >= 0xf9 && addr <= 0xfe) { 86 rtl_addr_delay(addr); 87 } else { 88 rtl_set_bbreg(hw, addr, MASKDWORD, data); 89 udelay(1); 90 } 91 } 92 EXPORT_SYMBOL(rtl_bb_delay); 93 94 static void rtl_fw_do_work(const struct firmware *firmware, void *context, 95 bool is_wow) 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, 102 "Firmware callback routine entered!\n"); 103 complete(&rtlpriv->firmware_loading_complete); 104 if (!firmware) { 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 } 114 pr_err("Selected firmware is not available\n"); 115 rtlpriv->max_fw_size = 0; 116 return; 117 } 118 found_alt: 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 } 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 } 134 rtlpriv->rtlhal.fwsize = firmware->size; 135 release_firmware(firmware); 136 } 137 138 void rtl_fw_cb(const struct firmware *firmware, void *context) 139 { 140 rtl_fw_do_work(firmware, context, false); 141 } 142 EXPORT_SYMBOL(rtl_fw_cb); 143 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 150 /*mutex for start & stop is must here. */ 151 static int rtl_op_start(struct ieee80211_hw *hw) 152 { 153 int err = 0; 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; 161 mutex_lock(&rtlpriv->locks.conf_mutex); 162 err = rtlpriv->intf_ops->adapter_start(hw); 163 if (!err) 164 rtl_watch_dog_timer_callback((unsigned long)hw); 165 mutex_unlock(&rtlpriv->locks.conf_mutex); 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)); 175 bool support_remote_wakeup = false; 176 177 if (is_hal_stop(rtlhal)) 178 return; 179 180 rtlpriv->cfg->ops->get_hw_reg(hw, HAL_DEF_WOWLAN, 181 (u8 *)(&support_remote_wakeup)); 182 /* here is must, because adhoc do stop and start, 183 * but stop with RFOFF may cause something wrong, 184 * like adhoc TP 185 */ 186 if (unlikely(ppsc->rfpwr_state == ERFOFF)) 187 rtl_ips_nic_on(hw); 188 189 mutex_lock(&rtlpriv->locks.conf_mutex); 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; 194 eth_zero_addr(mac->bssid); 195 mac->vendor = PEER_UNKNOWN; 196 197 /* reset sec info */ 198 rtl_cam_reset_sec_info(hw); 199 200 rtl_deinit_deferred_work(hw); 201 } 202 rtlpriv->intf_ops->adapter_stop(hw); 203 204 mutex_unlock(&rtlpriv->locks.conf_mutex); 205 } 206 207 static void rtl_op_tx(struct ieee80211_hw *hw, 208 struct ieee80211_tx_control *control, 209 struct sk_buff *skb) 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)); 214 struct rtl_tcb_desc tcb_desc; 215 memset(&tcb_desc, 0, sizeof(struct rtl_tcb_desc)); 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 223 if (!rtlpriv->intf_ops->waitq_insert(hw, control->sta, skb)) 224 rtlpriv->intf_ops->adapter_tx(hw, control->sta, skb, &tcb_desc); 225 return; 226 227 err_free: 228 dev_kfree_skb_any(skb); 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, 240 "vif has been set!! mac->vif = 0x%p\n", mac->vif); 241 return -EOPNOTSUPP; 242 } 243 244 vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER; 245 246 rtl_ips_nic_on(hw); 247 248 mutex_lock(&rtlpriv->locks.conf_mutex); 249 switch (ieee80211_vif_type_p2p(vif)) { 250 case NL80211_IFTYPE_P2P_CLIENT: 251 mac->p2p = P2P_ROLE_CLIENT; 252 /*fall through*/ 253 case NL80211_IFTYPE_STATION: 254 if (mac->beacon_enabled == 1) { 255 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 256 "NL80211_IFTYPE_STATION\n"); 257 mac->beacon_enabled = 0; 258 rtlpriv->cfg->ops->update_interrupt_mask(hw, 0, 259 rtlpriv->cfg->maps[RTL_IBSS_INT_MASKS]); 260 } 261 break; 262 case NL80211_IFTYPE_ADHOC: 263 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 264 "NL80211_IFTYPE_ADHOC\n"); 265 266 mac->link_state = MAC80211_LINKED; 267 rtlpriv->cfg->ops->set_bcn_reg(hw); 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, 273 (u8 *)(&mac->basic_rates)); 274 275 break; 276 case NL80211_IFTYPE_P2P_GO: 277 mac->p2p = P2P_ROLE_GO; 278 /*fall through*/ 279 case NL80211_IFTYPE_AP: 280 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 281 "NL80211_IFTYPE_AP\n"); 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, 290 (u8 *)(&mac->basic_rates)); 291 break; 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; 305 default: 306 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 307 "operation mode %d is not support!\n", vif->type); 308 err = -EOPNOTSUPP; 309 goto out; 310 } 311 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 } 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: 326 mutex_unlock(&rtlpriv->locks.conf_mutex); 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 336 mutex_lock(&rtlpriv->locks.conf_mutex); 337 338 /* Free beacon resources */ 339 if ((vif->type == NL80211_IFTYPE_AP) || 340 (vif->type == NL80211_IFTYPE_ADHOC) || 341 (vif->type == NL80211_IFTYPE_MESH_POINT)) { 342 if (mac->beacon_enabled == 1) { 343 mac->beacon_enabled = 0; 344 rtlpriv->cfg->ops->update_interrupt_mask(hw, 0, 345 rtlpriv->cfg->maps[RTL_IBSS_INT_MASKS]); 346 } 347 } 348 349 /* 350 *Note: We assume NL80211_IFTYPE_UNSPECIFIED as 351 *NO LINK for our hardware. 352 */ 353 mac->p2p = 0; 354 mac->vif = NULL; 355 mac->link_state = MAC80211_NOLINK; 356 eth_zero_addr(mac->bssid); 357 mac->vendor = PEER_UNKNOWN; 358 mac->opmode = NL80211_IFTYPE_UNSPECIFIED; 359 rtlpriv->cfg->ops->set_network_type(hw, mac->opmode); 360 361 mutex_unlock(&rtlpriv->locks.conf_mutex); 362 } 363 static int rtl_op_change_interface(struct ieee80211_hw *hw, 364 struct ieee80211_vif *vif, 365 enum nl80211_iftype new_type, bool p2p) 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, 375 "p2p %x\n", p2p); 376 return ret; 377 } 378 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\n", 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 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 598 if (mac->skip_scan) 599 return 1; 600 601 mutex_lock(&rtlpriv->locks.conf_mutex); 602 if (changed & IEEE80211_CONF_CHANGE_LISTEN_INTERVAL) { /* BIT(2)*/ 603 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 604 "IEEE80211_CONF_CHANGE_LISTEN_INTERVAL\n"); 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) { 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 */ 635 if (!rtlpriv->psc.multi_buffered) 636 queue_delayed_work(rtlpriv->works.rtl_wq, 637 &rtlpriv->works.ps_work, 638 MSECS(5)); 639 } else { 640 rtl_swlps_rf_awake(hw); 641 rtlpriv->psc.sw_ps_enabled = false; 642 } 643 } 644 645 if (changed & IEEE80211_CONF_CHANGE_RETRY_LIMITS) { 646 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 647 "IEEE80211_CONF_CHANGE_RETRY_LIMITS %x\n", 648 hw->conf.long_frame_max_tx_count); 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, 652 (u8 *)(&hw->conf.long_frame_max_tx_count)); 653 } 654 655 if (changed & IEEE80211_CONF_CHANGE_CHANNEL && 656 !rtlpriv->proximity.proxim_on) { 657 struct ieee80211_channel *channel = hw->conf.chandef.chan; 658 enum nl80211_chan_width width = hw->conf.chandef.width; 659 enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT; 660 u8 wide_chan = (u8) channel->hw_value; 661 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); 666 if (mac->act_scanning) 667 mac->n_channels++; 668 669 if (rtlpriv->dm.supp_phymode_switch && 670 mac->link_state < MAC80211_LINKED && 671 !mac->act_scanning) { 672 if (rtlpriv->cfg->ops->chk_switch_dmdp) 673 rtlpriv->cfg->ops->chk_switch_dmdp(hw); 674 } 675 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 */ 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 %#x not processed\n", 769 channel_type); 770 break; 771 } 772 } 773 774 if (wide_chan <= 0) 775 wide_chan = 1; 776 777 /* In scanning, when before we offchannel we may send a ps=1 778 * null to AP, and then we may send a ps = 0 null to AP quickly, 779 * but first null may have caused AP to put lots of packet to 780 * hw tx buffer. These packets must be tx'd before we go off 781 * channel so we must delay more time to let AP flush these 782 * packets before going offchannel, or dis-association or 783 * delete BA will be caused by AP 784 */ 785 if (rtlpriv->mac80211.offchan_delay) { 786 rtlpriv->mac80211.offchan_delay = false; 787 mdelay(50); 788 } 789 790 rtlphy->current_channel = wide_chan; 791 792 rtlpriv->cfg->ops->switch_channel(hw); 793 rtlpriv->cfg->ops->set_channel_access(hw); 794 rtlpriv->cfg->ops->set_bw_mode(hw, channel_type); 795 } 796 797 mutex_unlock(&rtlpriv->locks.conf_mutex); 798 799 return 0; 800 } 801 802 static void rtl_op_configure_filter(struct ieee80211_hw *hw, 803 unsigned int changed_flags, 804 unsigned int *new_flags, u64 multicast) 805 { 806 bool update_rcr = false; 807 struct rtl_priv *rtlpriv = rtl_priv(hw); 808 struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 809 810 *new_flags &= RTL_SUPPORTED_FILTERS; 811 if (0 == changed_flags) 812 return; 813 814 /*TODO: we disable broadcase now, so enable here */ 815 if (changed_flags & FIF_ALLMULTI) { 816 if (*new_flags & FIF_ALLMULTI) { 817 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_AM] | 818 rtlpriv->cfg->maps[MAC_RCR_AB]; 819 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 820 "Enable receive multicast frame\n"); 821 } else { 822 mac->rx_conf &= ~(rtlpriv->cfg->maps[MAC_RCR_AM] | 823 rtlpriv->cfg->maps[MAC_RCR_AB]); 824 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 825 "Disable receive multicast frame\n"); 826 } 827 update_rcr = true; 828 } 829 830 if (changed_flags & FIF_FCSFAIL) { 831 if (*new_flags & FIF_FCSFAIL) { 832 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_ACRC32]; 833 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 834 "Enable receive FCS error frame\n"); 835 } else { 836 mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_ACRC32]; 837 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 838 "Disable receive FCS error frame\n"); 839 } 840 if (!update_rcr) 841 update_rcr = true; 842 } 843 844 /* if ssid not set to hw don't check bssid 845 * here just used for linked scanning, & linked 846 * and nolink check bssid is set in set network_type 847 */ 848 if ((changed_flags & FIF_BCN_PRBRESP_PROMISC) && 849 (mac->link_state >= MAC80211_LINKED)) { 850 if (mac->opmode != NL80211_IFTYPE_AP && 851 mac->opmode != NL80211_IFTYPE_MESH_POINT) { 852 if (*new_flags & FIF_BCN_PRBRESP_PROMISC) 853 rtlpriv->cfg->ops->set_chk_bssid(hw, false); 854 else 855 rtlpriv->cfg->ops->set_chk_bssid(hw, true); 856 if (update_rcr) 857 update_rcr = false; 858 } 859 } 860 861 if (changed_flags & FIF_CONTROL) { 862 if (*new_flags & FIF_CONTROL) { 863 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_ACF]; 864 865 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 866 "Enable receive control frame.\n"); 867 } else { 868 mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_ACF]; 869 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 870 "Disable receive control frame.\n"); 871 } 872 if (!update_rcr) 873 update_rcr = true; 874 } 875 876 if (changed_flags & FIF_OTHER_BSS) { 877 if (*new_flags & FIF_OTHER_BSS) { 878 mac->rx_conf |= rtlpriv->cfg->maps[MAC_RCR_AAP]; 879 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 880 "Enable receive other BSS's frame.\n"); 881 } else { 882 mac->rx_conf &= ~rtlpriv->cfg->maps[MAC_RCR_AAP]; 883 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 884 "Disable receive other BSS's frame.\n"); 885 } 886 if (!update_rcr) 887 update_rcr = true; 888 } 889 890 if (update_rcr) 891 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_RCR, 892 (u8 *)(&mac->rx_conf)); 893 } 894 static int rtl_op_sta_add(struct ieee80211_hw *hw, 895 struct ieee80211_vif *vif, 896 struct ieee80211_sta *sta) 897 { 898 struct rtl_priv *rtlpriv = rtl_priv(hw); 899 struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 900 struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 901 struct rtl_sta_info *sta_entry; 902 903 if (sta) { 904 sta_entry = (struct rtl_sta_info *)sta->drv_priv; 905 spin_lock_bh(&rtlpriv->locks.entry_list_lock); 906 list_add_tail(&sta_entry->list, &rtlpriv->entry_list); 907 spin_unlock_bh(&rtlpriv->locks.entry_list_lock); 908 if (rtlhal->current_bandtype == BAND_ON_2_4G) { 909 sta_entry->wireless_mode = WIRELESS_MODE_G; 910 if (sta->supp_rates[0] <= 0xf) 911 sta_entry->wireless_mode = WIRELESS_MODE_B; 912 if (sta->ht_cap.ht_supported) 913 sta_entry->wireless_mode = WIRELESS_MODE_N_24G; 914 915 if (vif->type == NL80211_IFTYPE_ADHOC) 916 sta_entry->wireless_mode = WIRELESS_MODE_G; 917 } else if (rtlhal->current_bandtype == BAND_ON_5G) { 918 sta_entry->wireless_mode = WIRELESS_MODE_A; 919 if (sta->ht_cap.ht_supported) 920 sta_entry->wireless_mode = WIRELESS_MODE_N_5G; 921 if (sta->vht_cap.vht_supported) 922 sta_entry->wireless_mode = WIRELESS_MODE_AC_5G; 923 924 if (vif->type == NL80211_IFTYPE_ADHOC) 925 sta_entry->wireless_mode = WIRELESS_MODE_A; 926 } 927 /*disable cck rate for p2p*/ 928 if (mac->p2p) 929 sta->supp_rates[0] &= 0xfffffff0; 930 931 memcpy(sta_entry->mac_addr, sta->addr, ETH_ALEN); 932 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, 933 "Add sta addr is %pM\n", sta->addr); 934 rtlpriv->cfg->ops->update_rate_tbl(hw, sta, 0); 935 } 936 937 return 0; 938 } 939 940 static int rtl_op_sta_remove(struct ieee80211_hw *hw, 941 struct ieee80211_vif *vif, 942 struct ieee80211_sta *sta) 943 { 944 struct rtl_priv *rtlpriv = rtl_priv(hw); 945 struct rtl_sta_info *sta_entry; 946 if (sta) { 947 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, 948 "Remove sta addr is %pM\n", sta->addr); 949 sta_entry = (struct rtl_sta_info *)sta->drv_priv; 950 sta_entry->wireless_mode = 0; 951 sta_entry->ratr_index = 0; 952 spin_lock_bh(&rtlpriv->locks.entry_list_lock); 953 list_del(&sta_entry->list); 954 spin_unlock_bh(&rtlpriv->locks.entry_list_lock); 955 } 956 return 0; 957 } 958 static int _rtl_get_hal_qnum(u16 queue) 959 { 960 int qnum; 961 962 switch (queue) { 963 case 0: 964 qnum = AC3_VO; 965 break; 966 case 1: 967 qnum = AC2_VI; 968 break; 969 case 2: 970 qnum = AC0_BE; 971 break; 972 case 3: 973 qnum = AC1_BK; 974 break; 975 default: 976 qnum = AC0_BE; 977 break; 978 } 979 return qnum; 980 } 981 982 /* 983 *for mac80211 VO = 0, VI = 1, BE = 2, BK = 3 984 *for rtl819x BE = 0, BK = 1, VI = 2, VO = 3 985 */ 986 static int rtl_op_conf_tx(struct ieee80211_hw *hw, 987 struct ieee80211_vif *vif, u16 queue, 988 const struct ieee80211_tx_queue_params *param) 989 { 990 struct rtl_priv *rtlpriv = rtl_priv(hw); 991 struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 992 int aci; 993 994 if (queue >= AC_MAX) { 995 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, 996 "queue number %d is incorrect!\n", queue); 997 return -EINVAL; 998 } 999 1000 aci = _rtl_get_hal_qnum(queue); 1001 mac->ac[aci].aifs = param->aifs; 1002 mac->ac[aci].cw_min = cpu_to_le16(param->cw_min); 1003 mac->ac[aci].cw_max = cpu_to_le16(param->cw_max); 1004 mac->ac[aci].tx_op = cpu_to_le16(param->txop); 1005 memcpy(&mac->edca_param[aci], param, sizeof(*param)); 1006 rtlpriv->cfg->ops->set_qos(hw, aci); 1007 return 0; 1008 } 1009 1010 static void send_beacon_frame(struct ieee80211_hw *hw, 1011 struct ieee80211_vif *vif) 1012 { 1013 struct rtl_priv *rtlpriv = rtl_priv(hw); 1014 struct sk_buff *skb = ieee80211_beacon_get(hw, vif); 1015 struct rtl_tcb_desc tcb_desc; 1016 1017 if (skb) { 1018 memset(&tcb_desc, 0, sizeof(struct rtl_tcb_desc)); 1019 rtlpriv->intf_ops->adapter_tx(hw, NULL, skb, &tcb_desc); 1020 } 1021 } 1022 1023 static void rtl_op_bss_info_changed(struct ieee80211_hw *hw, 1024 struct ieee80211_vif *vif, 1025 struct ieee80211_bss_conf *bss_conf, 1026 u32 changed) 1027 { 1028 struct rtl_priv *rtlpriv = rtl_priv(hw); 1029 struct rtl_hal *rtlhal = rtl_hal(rtlpriv); 1030 struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 1031 struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 1032 1033 mutex_lock(&rtlpriv->locks.conf_mutex); 1034 if ((vif->type == NL80211_IFTYPE_ADHOC) || 1035 (vif->type == NL80211_IFTYPE_AP) || 1036 (vif->type == NL80211_IFTYPE_MESH_POINT)) { 1037 if ((changed & BSS_CHANGED_BEACON) || 1038 (changed & BSS_CHANGED_BEACON_ENABLED && 1039 bss_conf->enable_beacon)) { 1040 if (mac->beacon_enabled == 0) { 1041 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, 1042 "BSS_CHANGED_BEACON_ENABLED\n"); 1043 1044 /*start hw beacon interrupt. */ 1045 /*rtlpriv->cfg->ops->set_bcn_reg(hw); */ 1046 mac->beacon_enabled = 1; 1047 rtlpriv->cfg->ops->update_interrupt_mask(hw, 1048 rtlpriv->cfg->maps 1049 [RTL_IBSS_INT_MASKS], 0); 1050 1051 if (rtlpriv->cfg->ops->linked_set_reg) 1052 rtlpriv->cfg->ops->linked_set_reg(hw); 1053 send_beacon_frame(hw, vif); 1054 } 1055 } 1056 if ((changed & BSS_CHANGED_BEACON_ENABLED && 1057 !bss_conf->enable_beacon)) { 1058 if (mac->beacon_enabled == 1) { 1059 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, 1060 "ADHOC DISABLE BEACON\n"); 1061 1062 mac->beacon_enabled = 0; 1063 rtlpriv->cfg->ops->update_interrupt_mask(hw, 0, 1064 rtlpriv->cfg->maps 1065 [RTL_IBSS_INT_MASKS]); 1066 } 1067 } 1068 if (changed & BSS_CHANGED_BEACON_INT) { 1069 RT_TRACE(rtlpriv, COMP_BEACON, DBG_TRACE, 1070 "BSS_CHANGED_BEACON_INT\n"); 1071 mac->beacon_interval = bss_conf->beacon_int; 1072 rtlpriv->cfg->ops->set_bcn_intv(hw); 1073 } 1074 } 1075 1076 /*TODO: reference to enum ieee80211_bss_change */ 1077 if (changed & BSS_CHANGED_ASSOC) { 1078 u8 mstatus; 1079 if (bss_conf->assoc) { 1080 struct ieee80211_sta *sta = NULL; 1081 u8 keep_alive = 10; 1082 1083 mstatus = RT_MEDIA_CONNECT; 1084 /* we should reset all sec info & cam 1085 * before set cam after linked, we should not 1086 * reset in disassoc, that will cause tkip->wep 1087 * fail because some flag will be wrong */ 1088 /* reset sec info */ 1089 rtl_cam_reset_sec_info(hw); 1090 /* reset cam to fix wep fail issue 1091 * when change from wpa to wep */ 1092 rtl_cam_reset_all_entry(hw); 1093 1094 mac->link_state = MAC80211_LINKED; 1095 mac->cnt_after_linked = 0; 1096 mac->assoc_id = bss_conf->aid; 1097 memcpy(mac->bssid, bss_conf->bssid, ETH_ALEN); 1098 1099 if (rtlpriv->cfg->ops->linked_set_reg) 1100 rtlpriv->cfg->ops->linked_set_reg(hw); 1101 1102 rcu_read_lock(); 1103 sta = ieee80211_find_sta(vif, (u8 *)bss_conf->bssid); 1104 if (!sta) { 1105 rcu_read_unlock(); 1106 goto out; 1107 } 1108 RT_TRACE(rtlpriv, COMP_EASY_CONCURRENT, DBG_LOUD, 1109 "send PS STATIC frame\n"); 1110 if (rtlpriv->dm.supp_phymode_switch) { 1111 if (sta->ht_cap.ht_supported) 1112 rtl_send_smps_action(hw, sta, 1113 IEEE80211_SMPS_STATIC); 1114 } 1115 1116 if (rtlhal->current_bandtype == BAND_ON_5G) { 1117 mac->mode = WIRELESS_MODE_A; 1118 } else { 1119 if (sta->supp_rates[0] <= 0xf) 1120 mac->mode = WIRELESS_MODE_B; 1121 else 1122 mac->mode = WIRELESS_MODE_G; 1123 } 1124 1125 if (sta->ht_cap.ht_supported) { 1126 if (rtlhal->current_bandtype == BAND_ON_2_4G) 1127 mac->mode = WIRELESS_MODE_N_24G; 1128 else 1129 mac->mode = WIRELESS_MODE_N_5G; 1130 } 1131 1132 if (sta->vht_cap.vht_supported) { 1133 if (rtlhal->current_bandtype == BAND_ON_5G) 1134 mac->mode = WIRELESS_MODE_AC_5G; 1135 else 1136 mac->mode = WIRELESS_MODE_AC_24G; 1137 } 1138 1139 if (vif->type == NL80211_IFTYPE_STATION) 1140 rtlpriv->cfg->ops->update_rate_tbl(hw, sta, 0); 1141 rcu_read_unlock(); 1142 1143 /* to avoid AP Disassociation caused by inactivity */ 1144 rtlpriv->cfg->ops->set_hw_reg(hw, 1145 HW_VAR_KEEP_ALIVE, 1146 (u8 *)(&keep_alive)); 1147 1148 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, 1149 "BSS_CHANGED_ASSOC\n"); 1150 } else { 1151 mstatus = RT_MEDIA_DISCONNECT; 1152 1153 if (mac->link_state == MAC80211_LINKED) 1154 rtl_lps_leave(hw); 1155 if (ppsc->p2p_ps_info.p2p_ps_mode > P2P_PS_NONE) 1156 rtl_p2p_ps_cmd(hw, P2P_PS_DISABLE); 1157 mac->link_state = MAC80211_NOLINK; 1158 eth_zero_addr(mac->bssid); 1159 mac->vendor = PEER_UNKNOWN; 1160 mac->mode = 0; 1161 1162 if (rtlpriv->dm.supp_phymode_switch) { 1163 if (rtlpriv->cfg->ops->chk_switch_dmdp) 1164 rtlpriv->cfg->ops->chk_switch_dmdp(hw); 1165 } 1166 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, 1167 "BSS_CHANGED_UN_ASSOC\n"); 1168 } 1169 rtlpriv->cfg->ops->set_network_type(hw, vif->type); 1170 /* For FW LPS: 1171 * To tell firmware we have connected or disconnected 1172 */ 1173 rtlpriv->cfg->ops->set_hw_reg(hw, 1174 HW_VAR_H2C_FW_JOINBSSRPT, 1175 (u8 *)(&mstatus)); 1176 ppsc->report_linked = (mstatus == RT_MEDIA_CONNECT) ? 1177 true : false; 1178 1179 if (rtlpriv->cfg->ops->get_btc_status()) 1180 rtlpriv->btcoexist.btc_ops->btc_mediastatus_notify( 1181 rtlpriv, mstatus); 1182 } 1183 1184 if (changed & BSS_CHANGED_ERP_CTS_PROT) { 1185 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1186 "BSS_CHANGED_ERP_CTS_PROT\n"); 1187 mac->use_cts_protect = bss_conf->use_cts_prot; 1188 } 1189 1190 if (changed & BSS_CHANGED_ERP_PREAMBLE) { 1191 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, 1192 "BSS_CHANGED_ERP_PREAMBLE use short preamble:%x\n", 1193 bss_conf->use_short_preamble); 1194 1195 mac->short_preamble = bss_conf->use_short_preamble; 1196 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_ACK_PREAMBLE, 1197 (u8 *)(&mac->short_preamble)); 1198 } 1199 1200 if (changed & BSS_CHANGED_ERP_SLOT) { 1201 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1202 "BSS_CHANGED_ERP_SLOT\n"); 1203 1204 if (bss_conf->use_short_slot) 1205 mac->slot_time = RTL_SLOT_TIME_9; 1206 else 1207 mac->slot_time = RTL_SLOT_TIME_20; 1208 1209 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SLOT_TIME, 1210 (u8 *)(&mac->slot_time)); 1211 } 1212 1213 if (changed & BSS_CHANGED_HT) { 1214 struct ieee80211_sta *sta = NULL; 1215 1216 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1217 "BSS_CHANGED_HT\n"); 1218 1219 rcu_read_lock(); 1220 sta = ieee80211_find_sta(vif, (u8 *)bss_conf->bssid); 1221 if (sta) { 1222 if (sta->ht_cap.ampdu_density > 1223 mac->current_ampdu_density) 1224 mac->current_ampdu_density = 1225 sta->ht_cap.ampdu_density; 1226 if (sta->ht_cap.ampdu_factor < 1227 mac->current_ampdu_factor) 1228 mac->current_ampdu_factor = 1229 sta->ht_cap.ampdu_factor; 1230 } 1231 rcu_read_unlock(); 1232 1233 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_SHORTGI_DENSITY, 1234 (u8 *)(&mac->max_mss_density)); 1235 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AMPDU_FACTOR, 1236 &mac->current_ampdu_factor); 1237 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_AMPDU_MIN_SPACE, 1238 &mac->current_ampdu_density); 1239 } 1240 1241 if (changed & BSS_CHANGED_BSSID) { 1242 u32 basic_rates; 1243 struct ieee80211_sta *sta = NULL; 1244 1245 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BSSID, 1246 (u8 *)bss_conf->bssid); 1247 1248 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_DMESG, 1249 "bssid: %pM\n", bss_conf->bssid); 1250 1251 mac->vendor = PEER_UNKNOWN; 1252 memcpy(mac->bssid, bss_conf->bssid, ETH_ALEN); 1253 1254 rcu_read_lock(); 1255 sta = ieee80211_find_sta(vif, (u8 *)bss_conf->bssid); 1256 if (!sta) { 1257 rcu_read_unlock(); 1258 goto out; 1259 } 1260 1261 if (rtlhal->current_bandtype == BAND_ON_5G) { 1262 mac->mode = WIRELESS_MODE_A; 1263 } else { 1264 if (sta->supp_rates[0] <= 0xf) 1265 mac->mode = WIRELESS_MODE_B; 1266 else 1267 mac->mode = WIRELESS_MODE_G; 1268 } 1269 1270 if (sta->ht_cap.ht_supported) { 1271 if (rtlhal->current_bandtype == BAND_ON_2_4G) 1272 mac->mode = WIRELESS_MODE_N_24G; 1273 else 1274 mac->mode = WIRELESS_MODE_N_5G; 1275 } 1276 1277 if (sta->vht_cap.vht_supported) { 1278 if (rtlhal->current_bandtype == BAND_ON_5G) 1279 mac->mode = WIRELESS_MODE_AC_5G; 1280 else 1281 mac->mode = WIRELESS_MODE_AC_24G; 1282 } 1283 1284 /* just station need it, because ibss & ap mode will 1285 * set in sta_add, and will be NULL here */ 1286 if (vif->type == NL80211_IFTYPE_STATION) { 1287 struct rtl_sta_info *sta_entry; 1288 sta_entry = (struct rtl_sta_info *)sta->drv_priv; 1289 sta_entry->wireless_mode = mac->mode; 1290 } 1291 1292 if (sta->ht_cap.ht_supported) { 1293 mac->ht_enable = true; 1294 1295 /* 1296 * for cisco 1252 bw20 it's wrong 1297 * if (ht_cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) { 1298 * mac->bw_40 = true; 1299 * } 1300 * */ 1301 } 1302 1303 if (sta->vht_cap.vht_supported) 1304 mac->vht_enable = true; 1305 1306 if (changed & BSS_CHANGED_BASIC_RATES) { 1307 /* for 5G must << RATE_6M_INDEX = 4, 1308 * because 5G have no cck rate*/ 1309 if (rtlhal->current_bandtype == BAND_ON_5G) 1310 basic_rates = sta->supp_rates[1] << 4; 1311 else 1312 basic_rates = sta->supp_rates[0]; 1313 1314 mac->basic_rates = basic_rates; 1315 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_BASIC_RATE, 1316 (u8 *)(&basic_rates)); 1317 } 1318 rcu_read_unlock(); 1319 } 1320 out: 1321 mutex_unlock(&rtlpriv->locks.conf_mutex); 1322 } 1323 1324 static u64 rtl_op_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif) 1325 { 1326 struct rtl_priv *rtlpriv = rtl_priv(hw); 1327 u64 tsf; 1328 1329 rtlpriv->cfg->ops->get_hw_reg(hw, HW_VAR_CORRECT_TSF, (u8 *)(&tsf)); 1330 return tsf; 1331 } 1332 1333 static void rtl_op_set_tsf(struct ieee80211_hw *hw, 1334 struct ieee80211_vif *vif, u64 tsf) 1335 { 1336 struct rtl_priv *rtlpriv = rtl_priv(hw); 1337 struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 1338 u8 bibss = (mac->opmode == NL80211_IFTYPE_ADHOC) ? 1 : 0; 1339 1340 mac->tsf = tsf; 1341 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_CORRECT_TSF, (u8 *)(&bibss)); 1342 } 1343 1344 static void rtl_op_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif) 1345 { 1346 struct rtl_priv *rtlpriv = rtl_priv(hw); 1347 u8 tmp = 0; 1348 1349 rtlpriv->cfg->ops->set_hw_reg(hw, HW_VAR_DUAL_TSF_RST, (u8 *)(&tmp)); 1350 } 1351 1352 static void rtl_op_sta_notify(struct ieee80211_hw *hw, 1353 struct ieee80211_vif *vif, 1354 enum sta_notify_cmd cmd, 1355 struct ieee80211_sta *sta) 1356 { 1357 switch (cmd) { 1358 case STA_NOTIFY_SLEEP: 1359 break; 1360 case STA_NOTIFY_AWAKE: 1361 break; 1362 default: 1363 break; 1364 } 1365 } 1366 1367 static int rtl_op_ampdu_action(struct ieee80211_hw *hw, 1368 struct ieee80211_vif *vif, 1369 struct ieee80211_ampdu_params *params) 1370 { 1371 struct rtl_priv *rtlpriv = rtl_priv(hw); 1372 struct ieee80211_sta *sta = params->sta; 1373 enum ieee80211_ampdu_mlme_action action = params->action; 1374 u16 tid = params->tid; 1375 u16 *ssn = ¶ms->ssn; 1376 1377 switch (action) { 1378 case IEEE80211_AMPDU_TX_START: 1379 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1380 "IEEE80211_AMPDU_TX_START: TID:%d\n", tid); 1381 return rtl_tx_agg_start(hw, vif, sta, tid, ssn); 1382 case IEEE80211_AMPDU_TX_STOP_CONT: 1383 case IEEE80211_AMPDU_TX_STOP_FLUSH: 1384 case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: 1385 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1386 "IEEE80211_AMPDU_TX_STOP: TID:%d\n", tid); 1387 return rtl_tx_agg_stop(hw, vif, sta, tid); 1388 case IEEE80211_AMPDU_TX_OPERATIONAL: 1389 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1390 "IEEE80211_AMPDU_TX_OPERATIONAL:TID:%d\n", tid); 1391 rtl_tx_agg_oper(hw, sta, tid); 1392 break; 1393 case IEEE80211_AMPDU_RX_START: 1394 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1395 "IEEE80211_AMPDU_RX_START:TID:%d\n", tid); 1396 return rtl_rx_agg_start(hw, sta, tid); 1397 case IEEE80211_AMPDU_RX_STOP: 1398 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_TRACE, 1399 "IEEE80211_AMPDU_RX_STOP:TID:%d\n", tid); 1400 return rtl_rx_agg_stop(hw, sta, tid); 1401 default: 1402 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 1403 "IEEE80211_AMPDU_ERR!!!!:\n"); 1404 return -EOPNOTSUPP; 1405 } 1406 return 0; 1407 } 1408 1409 static void rtl_op_sw_scan_start(struct ieee80211_hw *hw, 1410 struct ieee80211_vif *vif, 1411 const u8 *mac_addr) 1412 { 1413 struct rtl_priv *rtlpriv = rtl_priv(hw); 1414 struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 1415 1416 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, "\n"); 1417 mac->act_scanning = true; 1418 if (rtlpriv->link_info.higher_busytraffic) { 1419 mac->skip_scan = true; 1420 return; 1421 } 1422 1423 if (rtlpriv->cfg->ops->get_btc_status()) 1424 rtlpriv->btcoexist.btc_ops->btc_scan_notify(rtlpriv, 1); 1425 1426 if (rtlpriv->dm.supp_phymode_switch) { 1427 if (rtlpriv->cfg->ops->chk_switch_dmdp) 1428 rtlpriv->cfg->ops->chk_switch_dmdp(hw); 1429 } 1430 1431 if (mac->link_state == MAC80211_LINKED) { 1432 rtl_lps_leave(hw); 1433 mac->link_state = MAC80211_LINKED_SCANNING; 1434 } else { 1435 rtl_ips_nic_on(hw); 1436 } 1437 1438 /* Dul mac */ 1439 rtlpriv->rtlhal.load_imrandiqk_setting_for2g = false; 1440 1441 rtlpriv->cfg->ops->led_control(hw, LED_CTL_SITE_SURVEY); 1442 rtlpriv->cfg->ops->scan_operation_backup(hw, SCAN_OPT_BACKUP_BAND0); 1443 } 1444 1445 static void rtl_op_sw_scan_complete(struct ieee80211_hw *hw, 1446 struct ieee80211_vif *vif) 1447 { 1448 struct rtl_priv *rtlpriv = rtl_priv(hw); 1449 struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 1450 1451 RT_TRACE(rtlpriv, COMP_MAC80211, DBG_LOUD, "\n"); 1452 mac->act_scanning = false; 1453 mac->skip_scan = false; 1454 if (rtlpriv->link_info.higher_busytraffic) 1455 return; 1456 1457 /* p2p will use 1/6/11 to scan */ 1458 if (mac->n_channels == 3) 1459 mac->p2p_in_use = true; 1460 else 1461 mac->p2p_in_use = false; 1462 mac->n_channels = 0; 1463 /* Dul mac */ 1464 rtlpriv->rtlhal.load_imrandiqk_setting_for2g = false; 1465 1466 if (mac->link_state == MAC80211_LINKED_SCANNING) { 1467 mac->link_state = MAC80211_LINKED; 1468 if (mac->opmode == NL80211_IFTYPE_STATION) { 1469 /* fix fwlps issue */ 1470 rtlpriv->cfg->ops->set_network_type(hw, mac->opmode); 1471 } 1472 } 1473 1474 rtlpriv->cfg->ops->scan_operation_backup(hw, SCAN_OPT_RESTORE); 1475 if (rtlpriv->cfg->ops->get_btc_status()) 1476 rtlpriv->btcoexist.btc_ops->btc_scan_notify(rtlpriv, 0); 1477 } 1478 1479 static int rtl_op_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, 1480 struct ieee80211_vif *vif, struct ieee80211_sta *sta, 1481 struct ieee80211_key_conf *key) 1482 { 1483 struct rtl_priv *rtlpriv = rtl_priv(hw); 1484 u8 key_type = NO_ENCRYPTION; 1485 u8 key_idx; 1486 bool group_key = false; 1487 bool wep_only = false; 1488 int err = 0; 1489 u8 mac_addr[ETH_ALEN]; 1490 u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 1491 1492 if (rtlpriv->cfg->mod_params->sw_crypto || rtlpriv->sec.use_sw_sec) { 1493 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING, 1494 "not open hw encryption\n"); 1495 return -ENOSPC; /*User disabled HW-crypto */ 1496 } 1497 /* To support IBSS, use sw-crypto for GTK */ 1498 if (((vif->type == NL80211_IFTYPE_ADHOC) || 1499 (vif->type == NL80211_IFTYPE_MESH_POINT)) && 1500 !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) 1501 return -ENOSPC; 1502 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, 1503 "%s hardware based encryption for keyidx: %d, mac: %pM\n", 1504 cmd == SET_KEY ? "Using" : "Disabling", key->keyidx, 1505 sta ? sta->addr : bcast_addr); 1506 rtlpriv->sec.being_setkey = true; 1507 rtl_ips_nic_on(hw); 1508 mutex_lock(&rtlpriv->locks.conf_mutex); 1509 /* <1> get encryption alg */ 1510 1511 switch (key->cipher) { 1512 case WLAN_CIPHER_SUITE_WEP40: 1513 key_type = WEP40_ENCRYPTION; 1514 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:WEP40\n"); 1515 break; 1516 case WLAN_CIPHER_SUITE_WEP104: 1517 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:WEP104\n"); 1518 key_type = WEP104_ENCRYPTION; 1519 break; 1520 case WLAN_CIPHER_SUITE_TKIP: 1521 key_type = TKIP_ENCRYPTION; 1522 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:TKIP\n"); 1523 break; 1524 case WLAN_CIPHER_SUITE_CCMP: 1525 key_type = AESCCMP_ENCRYPTION; 1526 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:CCMP\n"); 1527 break; 1528 case WLAN_CIPHER_SUITE_AES_CMAC: 1529 /* HW don't support CMAC encryption, 1530 * use software CMAC encryption 1531 */ 1532 key_type = AESCMAC_ENCRYPTION; 1533 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, "alg:CMAC\n"); 1534 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, 1535 "HW don't support CMAC encrypiton, use software CMAC encrypiton\n"); 1536 err = -EOPNOTSUPP; 1537 goto out_unlock; 1538 default: 1539 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 1540 "alg_err:%x!!!!:\n", key->cipher); 1541 goto out_unlock; 1542 } 1543 if (key_type == WEP40_ENCRYPTION || 1544 key_type == WEP104_ENCRYPTION || 1545 vif->type == NL80211_IFTYPE_ADHOC) 1546 rtlpriv->sec.use_defaultkey = true; 1547 1548 /* <2> get key_idx */ 1549 key_idx = (u8) (key->keyidx); 1550 if (key_idx > 3) 1551 goto out_unlock; 1552 /* <3> if pairwise key enable_hw_sec */ 1553 group_key = !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE); 1554 1555 /* wep always be group key, but there are two conditions: 1556 * 1) wep only: is just for wep enc, in this condition 1557 * rtlpriv->sec.pairwise_enc_algorithm == NO_ENCRYPTION 1558 * will be true & enable_hw_sec will be set when wep 1559 * ke setting. 1560 * 2) wep(group) + AES(pairwise): some AP like cisco 1561 * may use it, in this condition enable_hw_sec will not 1562 * be set when wep key setting */ 1563 /* we must reset sec_info after lingked before set key, 1564 * or some flag will be wrong*/ 1565 if (vif->type == NL80211_IFTYPE_AP || 1566 vif->type == NL80211_IFTYPE_MESH_POINT) { 1567 if (!group_key || key_type == WEP40_ENCRYPTION || 1568 key_type == WEP104_ENCRYPTION) { 1569 if (group_key) 1570 wep_only = true; 1571 rtlpriv->cfg->ops->enable_hw_sec(hw); 1572 } 1573 } else { 1574 if ((!group_key) || (vif->type == NL80211_IFTYPE_ADHOC) || 1575 rtlpriv->sec.pairwise_enc_algorithm == NO_ENCRYPTION) { 1576 if (rtlpriv->sec.pairwise_enc_algorithm == 1577 NO_ENCRYPTION && 1578 (key_type == WEP40_ENCRYPTION || 1579 key_type == WEP104_ENCRYPTION)) 1580 wep_only = true; 1581 rtlpriv->sec.pairwise_enc_algorithm = key_type; 1582 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, 1583 "set enable_hw_sec, key_type:%x(OPEN:0 WEP40:1 TKIP:2 AES:4 WEP104:5)\n", 1584 key_type); 1585 rtlpriv->cfg->ops->enable_hw_sec(hw); 1586 } 1587 } 1588 /* <4> set key based on cmd */ 1589 switch (cmd) { 1590 case SET_KEY: 1591 if (wep_only) { 1592 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, 1593 "set WEP(group/pairwise) key\n"); 1594 /* Pairwise key with an assigned MAC address. */ 1595 rtlpriv->sec.pairwise_enc_algorithm = key_type; 1596 rtlpriv->sec.group_enc_algorithm = key_type; 1597 /*set local buf about wep key. */ 1598 memcpy(rtlpriv->sec.key_buf[key_idx], 1599 key->key, key->keylen); 1600 rtlpriv->sec.key_len[key_idx] = key->keylen; 1601 eth_zero_addr(mac_addr); 1602 } else if (group_key) { /* group key */ 1603 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, 1604 "set group key\n"); 1605 /* group key */ 1606 rtlpriv->sec.group_enc_algorithm = key_type; 1607 /*set local buf about group key. */ 1608 memcpy(rtlpriv->sec.key_buf[key_idx], 1609 key->key, key->keylen); 1610 rtlpriv->sec.key_len[key_idx] = key->keylen; 1611 memcpy(mac_addr, bcast_addr, ETH_ALEN); 1612 } else { /* pairwise key */ 1613 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, 1614 "set pairwise key\n"); 1615 if (!sta) { 1616 RT_ASSERT(false, 1617 "pairwise key without mac_addr\n"); 1618 1619 err = -EOPNOTSUPP; 1620 goto out_unlock; 1621 } 1622 /* Pairwise key with an assigned MAC address. */ 1623 rtlpriv->sec.pairwise_enc_algorithm = key_type; 1624 /*set local buf about pairwise key. */ 1625 memcpy(rtlpriv->sec.key_buf[PAIRWISE_KEYIDX], 1626 key->key, key->keylen); 1627 rtlpriv->sec.key_len[PAIRWISE_KEYIDX] = key->keylen; 1628 rtlpriv->sec.pairwise_key = 1629 rtlpriv->sec.key_buf[PAIRWISE_KEYIDX]; 1630 memcpy(mac_addr, sta->addr, ETH_ALEN); 1631 } 1632 rtlpriv->cfg->ops->set_key(hw, key_idx, mac_addr, 1633 group_key, key_type, wep_only, 1634 false); 1635 /* <5> tell mac80211 do something: */ 1636 /*must use sw generate IV, or can not work !!!!. */ 1637 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; 1638 key->hw_key_idx = key_idx; 1639 if (key_type == TKIP_ENCRYPTION) 1640 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC; 1641 /*use software CCMP encryption for management frames (MFP) */ 1642 if (key_type == AESCCMP_ENCRYPTION) 1643 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; 1644 break; 1645 case DISABLE_KEY: 1646 RT_TRACE(rtlpriv, COMP_SEC, DBG_DMESG, 1647 "disable key delete one entry\n"); 1648 /*set local buf about wep key. */ 1649 if (vif->type == NL80211_IFTYPE_AP || 1650 vif->type == NL80211_IFTYPE_MESH_POINT) { 1651 if (sta) 1652 rtl_cam_del_entry(hw, sta->addr); 1653 } 1654 memset(rtlpriv->sec.key_buf[key_idx], 0, key->keylen); 1655 rtlpriv->sec.key_len[key_idx] = 0; 1656 eth_zero_addr(mac_addr); 1657 /* 1658 *mac80211 will delete entrys one by one, 1659 *so don't use rtl_cam_reset_all_entry 1660 *or clear all entry here. 1661 */ 1662 rtl_cam_delete_one_entry(hw, mac_addr, key_idx); 1663 break; 1664 default: 1665 RT_TRACE(rtlpriv, COMP_ERR, DBG_EMERG, 1666 "cmd_err:%x!!!!:\n", cmd); 1667 } 1668 out_unlock: 1669 mutex_unlock(&rtlpriv->locks.conf_mutex); 1670 rtlpriv->sec.being_setkey = false; 1671 return err; 1672 } 1673 1674 static void rtl_op_rfkill_poll(struct ieee80211_hw *hw) 1675 { 1676 struct rtl_priv *rtlpriv = rtl_priv(hw); 1677 1678 bool radio_state; 1679 bool blocked; 1680 u8 valid = 0; 1681 1682 if (!test_bit(RTL_STATUS_INTERFACE_START, &rtlpriv->status)) 1683 return; 1684 1685 mutex_lock(&rtlpriv->locks.conf_mutex); 1686 1687 /*if Radio On return true here */ 1688 radio_state = rtlpriv->cfg->ops->radio_onoff_checking(hw, &valid); 1689 1690 if (valid) { 1691 if (unlikely(radio_state != rtlpriv->rfkill.rfkill_state)) { 1692 rtlpriv->rfkill.rfkill_state = radio_state; 1693 1694 RT_TRACE(rtlpriv, COMP_RF, DBG_DMESG, 1695 "wireless radio switch turned %s\n", 1696 radio_state ? "on" : "off"); 1697 1698 blocked = (rtlpriv->rfkill.rfkill_state == 1) ? 0 : 1; 1699 wiphy_rfkill_set_hw_state(hw->wiphy, blocked); 1700 } 1701 } 1702 1703 mutex_unlock(&rtlpriv->locks.conf_mutex); 1704 } 1705 1706 /* this function is called by mac80211 to flush tx buffer 1707 * before switch channle or power save, or tx buffer packet 1708 * maybe send after offchannel or rf sleep, this may cause 1709 * dis-association by AP */ 1710 static void rtl_op_flush(struct ieee80211_hw *hw, 1711 struct ieee80211_vif *vif, 1712 u32 queues, 1713 bool drop) 1714 { 1715 struct rtl_priv *rtlpriv = rtl_priv(hw); 1716 1717 if (rtlpriv->intf_ops->flush) 1718 rtlpriv->intf_ops->flush(hw, queues, drop); 1719 } 1720 1721 /* Description: 1722 * This routine deals with the Power Configuration CMD 1723 * parsing for RTL8723/RTL8188E Series IC. 1724 * Assumption: 1725 * We should follow specific format that was released from HW SD. 1726 */ 1727 bool rtl_hal_pwrseqcmdparsing(struct rtl_priv *rtlpriv, u8 cut_version, 1728 u8 faversion, u8 interface_type, 1729 struct wlan_pwr_cfg pwrcfgcmd[]) 1730 { 1731 struct wlan_pwr_cfg cfg_cmd = {0}; 1732 bool polling_bit = false; 1733 u32 ary_idx = 0; 1734 u8 value = 0; 1735 u32 offset = 0; 1736 u32 polling_count = 0; 1737 u32 max_polling_cnt = 5000; 1738 1739 do { 1740 cfg_cmd = pwrcfgcmd[ary_idx]; 1741 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 1742 "rtl_hal_pwrseqcmdparsing(): offset(%#x),cut_msk(%#x), famsk(%#x), interface_msk(%#x), base(%#x), cmd(%#x), msk(%#x), value(%#x)\n", 1743 GET_PWR_CFG_OFFSET(cfg_cmd), 1744 GET_PWR_CFG_CUT_MASK(cfg_cmd), 1745 GET_PWR_CFG_FAB_MASK(cfg_cmd), 1746 GET_PWR_CFG_INTF_MASK(cfg_cmd), 1747 GET_PWR_CFG_BASE(cfg_cmd), GET_PWR_CFG_CMD(cfg_cmd), 1748 GET_PWR_CFG_MASK(cfg_cmd), GET_PWR_CFG_VALUE(cfg_cmd)); 1749 1750 if ((GET_PWR_CFG_FAB_MASK(cfg_cmd)&faversion) && 1751 (GET_PWR_CFG_CUT_MASK(cfg_cmd)&cut_version) && 1752 (GET_PWR_CFG_INTF_MASK(cfg_cmd)&interface_type)) { 1753 switch (GET_PWR_CFG_CMD(cfg_cmd)) { 1754 case PWR_CMD_READ: 1755 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 1756 "rtl_hal_pwrseqcmdparsing(): PWR_CMD_READ\n"); 1757 break; 1758 case PWR_CMD_WRITE: 1759 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 1760 "rtl_hal_pwrseqcmdparsing(): PWR_CMD_WRITE\n"); 1761 offset = GET_PWR_CFG_OFFSET(cfg_cmd); 1762 1763 /*Read the value from system register*/ 1764 value = rtl_read_byte(rtlpriv, offset); 1765 value &= (~(GET_PWR_CFG_MASK(cfg_cmd))); 1766 value |= (GET_PWR_CFG_VALUE(cfg_cmd) & 1767 GET_PWR_CFG_MASK(cfg_cmd)); 1768 1769 /*Write the value back to sytem register*/ 1770 rtl_write_byte(rtlpriv, offset, value); 1771 break; 1772 case PWR_CMD_POLLING: 1773 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 1774 "rtl_hal_pwrseqcmdparsing(): PWR_CMD_POLLING\n"); 1775 polling_bit = false; 1776 offset = GET_PWR_CFG_OFFSET(cfg_cmd); 1777 1778 do { 1779 value = rtl_read_byte(rtlpriv, offset); 1780 1781 value &= GET_PWR_CFG_MASK(cfg_cmd); 1782 if (value == 1783 (GET_PWR_CFG_VALUE(cfg_cmd) & 1784 GET_PWR_CFG_MASK(cfg_cmd))) 1785 polling_bit = true; 1786 else 1787 udelay(10); 1788 1789 if (polling_count++ > max_polling_cnt) 1790 return false; 1791 } while (!polling_bit); 1792 break; 1793 case PWR_CMD_DELAY: 1794 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 1795 "rtl_hal_pwrseqcmdparsing(): PWR_CMD_DELAY\n"); 1796 if (GET_PWR_CFG_VALUE(cfg_cmd) == 1797 PWRSEQ_DELAY_US) 1798 udelay(GET_PWR_CFG_OFFSET(cfg_cmd)); 1799 else 1800 mdelay(GET_PWR_CFG_OFFSET(cfg_cmd)); 1801 break; 1802 case PWR_CMD_END: 1803 RT_TRACE(rtlpriv, COMP_INIT, DBG_TRACE, 1804 "rtl_hal_pwrseqcmdparsing(): PWR_CMD_END\n"); 1805 return true; 1806 default: 1807 RT_ASSERT(false, 1808 "rtl_hal_pwrseqcmdparsing(): Unknown CMD!!\n"); 1809 break; 1810 } 1811 } 1812 ary_idx++; 1813 } while (1); 1814 1815 return true; 1816 } 1817 EXPORT_SYMBOL(rtl_hal_pwrseqcmdparsing); 1818 1819 bool rtl_cmd_send_packet(struct ieee80211_hw *hw, struct sk_buff *skb) 1820 { 1821 struct rtl_priv *rtlpriv = rtl_priv(hw); 1822 struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 1823 struct rtl8192_tx_ring *ring; 1824 struct rtl_tx_desc *pdesc; 1825 unsigned long flags; 1826 struct sk_buff *pskb = NULL; 1827 1828 ring = &rtlpci->tx_ring[BEACON_QUEUE]; 1829 1830 spin_lock_irqsave(&rtlpriv->locks.irq_th_lock, flags); 1831 pskb = __skb_dequeue(&ring->queue); 1832 if (pskb) 1833 dev_kfree_skb_irq(pskb); 1834 1835 /*this is wrong, fill_tx_cmddesc needs update*/ 1836 pdesc = &ring->desc[0]; 1837 1838 rtlpriv->cfg->ops->fill_tx_cmddesc(hw, (u8 *)pdesc, 1, 1, skb); 1839 1840 __skb_queue_tail(&ring->queue, skb); 1841 1842 spin_unlock_irqrestore(&rtlpriv->locks.irq_th_lock, flags); 1843 1844 rtlpriv->cfg->ops->tx_polling(hw, BEACON_QUEUE); 1845 1846 return true; 1847 } 1848 EXPORT_SYMBOL(rtl_cmd_send_packet); 1849 const struct ieee80211_ops rtl_ops = { 1850 .start = rtl_op_start, 1851 .stop = rtl_op_stop, 1852 .tx = rtl_op_tx, 1853 .add_interface = rtl_op_add_interface, 1854 .remove_interface = rtl_op_remove_interface, 1855 .change_interface = rtl_op_change_interface, 1856 #ifdef CONFIG_PM 1857 .suspend = rtl_op_suspend, 1858 .resume = rtl_op_resume, 1859 #endif 1860 .config = rtl_op_config, 1861 .configure_filter = rtl_op_configure_filter, 1862 .set_key = rtl_op_set_key, 1863 .conf_tx = rtl_op_conf_tx, 1864 .bss_info_changed = rtl_op_bss_info_changed, 1865 .get_tsf = rtl_op_get_tsf, 1866 .set_tsf = rtl_op_set_tsf, 1867 .reset_tsf = rtl_op_reset_tsf, 1868 .sta_notify = rtl_op_sta_notify, 1869 .ampdu_action = rtl_op_ampdu_action, 1870 .sw_scan_start = rtl_op_sw_scan_start, 1871 .sw_scan_complete = rtl_op_sw_scan_complete, 1872 .rfkill_poll = rtl_op_rfkill_poll, 1873 .sta_add = rtl_op_sta_add, 1874 .sta_remove = rtl_op_sta_remove, 1875 .flush = rtl_op_flush, 1876 }; 1877 EXPORT_SYMBOL_GPL(rtl_ops); 1878 1879 bool rtl_btc_status_false(void) 1880 { 1881 return false; 1882 } 1883 EXPORT_SYMBOL_GPL(rtl_btc_status_false); 1884 1885 void rtl_dm_diginit(struct ieee80211_hw *hw, u32 cur_igvalue) 1886 { 1887 struct rtl_priv *rtlpriv = rtl_priv(hw); 1888 struct dig_t *dm_digtable = &rtlpriv->dm_digtable; 1889 1890 dm_digtable->dig_enable_flag = true; 1891 dm_digtable->dig_ext_port_stage = DIG_EXT_PORT_STAGE_MAX; 1892 dm_digtable->cur_igvalue = cur_igvalue; 1893 dm_digtable->pre_igvalue = 0; 1894 dm_digtable->cur_sta_cstate = DIG_STA_DISCONNECT; 1895 dm_digtable->presta_cstate = DIG_STA_DISCONNECT; 1896 dm_digtable->curmultista_cstate = DIG_MULTISTA_DISCONNECT; 1897 dm_digtable->rssi_lowthresh = DM_DIG_THRESH_LOW; 1898 dm_digtable->rssi_highthresh = DM_DIG_THRESH_HIGH; 1899 dm_digtable->fa_lowthresh = DM_FALSEALARM_THRESH_LOW; 1900 dm_digtable->fa_highthresh = DM_FALSEALARM_THRESH_HIGH; 1901 dm_digtable->rx_gain_max = DM_DIG_MAX; 1902 dm_digtable->rx_gain_min = DM_DIG_MIN; 1903 dm_digtable->back_val = DM_DIG_BACKOFF_DEFAULT; 1904 dm_digtable->back_range_max = DM_DIG_BACKOFF_MAX; 1905 dm_digtable->back_range_min = DM_DIG_BACKOFF_MIN; 1906 dm_digtable->pre_cck_cca_thres = 0xff; 1907 dm_digtable->cur_cck_cca_thres = 0x83; 1908 dm_digtable->forbidden_igi = DM_DIG_MIN; 1909 dm_digtable->large_fa_hit = 0; 1910 dm_digtable->recover_cnt = 0; 1911 dm_digtable->dig_min_0 = 0x25; 1912 dm_digtable->dig_min_1 = 0x25; 1913 dm_digtable->media_connect_0 = false; 1914 dm_digtable->media_connect_1 = false; 1915 rtlpriv->dm.dm_initialgain_enable = true; 1916 dm_digtable->bt30_cur_igi = 0x32; 1917 dm_digtable->pre_cck_pd_state = CCK_PD_STAGE_MAX; 1918 dm_digtable->cur_cck_pd_state = CCK_PD_STAGE_LOWRSSI; 1919 } 1920 EXPORT_SYMBOL(rtl_dm_diginit); 1921