1// SPDX-License-Identifier: ISC 2/* Copyright (C) 2020 MediaTek Inc. */ 3 4#include <linux/etherdevice.h> 5#include <linux/platform_device.h> 6#include <linux/pci.h> 7#include <linux/module.h> 8#include "mt7915.h" 9#include "mcu.h" 10 11static bool mt7915_dev_running(struct mt7915_dev *dev) 12{ 13 struct mt7915_phy *phy; 14 15 if (test_bit(MT76_STATE_RUNNING, &dev->mphy.state)) 16 return true; 17 18 phy = mt7915_ext_phy(dev); 19 20 return phy && test_bit(MT76_STATE_RUNNING, &phy->mt76->state); 21} 22 23int mt7915_run(struct ieee80211_hw *hw) 24{ 25 struct mt7915_dev *dev = mt7915_hw_dev(hw); 26 struct mt7915_phy *phy = mt7915_hw_phy(hw); 27 bool running; 28 int ret; 29 30 running = mt7915_dev_running(dev); 31 32 if (!running) { 33 ret = mt76_connac_mcu_set_pm(&dev->mt76, 34 dev->phy.mt76->band_idx, 0); 35 if (ret) 36 goto out; 37 38 ret = mt7915_mcu_set_mac(dev, dev->phy.mt76->band_idx, 39 true, true); 40 if (ret) 41 goto out; 42 43 mt7915_mac_enable_nf(dev, dev->phy.mt76->band_idx); 44 } 45 46 if (phy != &dev->phy) { 47 ret = mt76_connac_mcu_set_pm(&dev->mt76, 48 phy->mt76->band_idx, 0); 49 if (ret) 50 goto out; 51 52 ret = mt7915_mcu_set_mac(dev, phy->mt76->band_idx, 53 true, true); 54 if (ret) 55 goto out; 56 57 mt7915_mac_enable_nf(dev, phy->mt76->band_idx); 58 } 59 60 ret = mt7915_mcu_set_thermal_throttling(phy, 61 MT7915_THERMAL_THROTTLE_MAX); 62 63 if (ret) 64 goto out; 65 66 ret = mt7915_mcu_set_thermal_protect(phy); 67 68 if (ret) 69 goto out; 70 71 ret = mt76_connac_mcu_set_rts_thresh(&dev->mt76, 0x92b, 72 phy->mt76->band_idx); 73 if (ret) 74 goto out; 75 76 ret = mt7915_mcu_set_sku_en(phy, true); 77 if (ret) 78 goto out; 79 80 ret = mt7915_mcu_set_chan_info(phy, MCU_EXT_CMD(SET_RX_PATH)); 81 if (ret) 82 goto out; 83 84 set_bit(MT76_STATE_RUNNING, &phy->mt76->state); 85 86 if (!mt76_testmode_enabled(phy->mt76)) 87 ieee80211_queue_delayed_work(hw, &phy->mt76->mac_work, 88 MT7915_WATCHDOG_TIME); 89 90 if (!running) 91 mt7915_mac_reset_counters(phy); 92 93out: 94 return ret; 95} 96 97static int mt7915_start(struct ieee80211_hw *hw) 98{ 99 struct mt7915_dev *dev = mt7915_hw_dev(hw); 100 int ret; 101 102 flush_work(&dev->init_work); 103 104 mutex_lock(&dev->mt76.mutex); 105 ret = mt7915_run(hw); 106 mutex_unlock(&dev->mt76.mutex); 107 108 return ret; 109} 110 111static void mt7915_stop(struct ieee80211_hw *hw) 112{ 113 struct mt7915_dev *dev = mt7915_hw_dev(hw); 114 struct mt7915_phy *phy = mt7915_hw_phy(hw); 115 116 cancel_delayed_work_sync(&phy->mt76->mac_work); 117 118 mutex_lock(&dev->mt76.mutex); 119 120 mt76_testmode_reset(phy->mt76, true); 121 122 clear_bit(MT76_STATE_RUNNING, &phy->mt76->state); 123 124 if (phy != &dev->phy) { 125 mt76_connac_mcu_set_pm(&dev->mt76, phy->mt76->band_idx, 1); 126 mt7915_mcu_set_mac(dev, phy->mt76->band_idx, false, false); 127 } 128 129 if (!mt7915_dev_running(dev)) { 130 mt76_connac_mcu_set_pm(&dev->mt76, dev->phy.mt76->band_idx, 1); 131 mt7915_mcu_set_mac(dev, dev->phy.mt76->band_idx, false, false); 132 } 133 134 mutex_unlock(&dev->mt76.mutex); 135} 136 137static inline int get_free_idx(u32 mask, u8 start, u8 end) 138{ 139 return ffs(~mask & GENMASK(end, start)); 140} 141 142static int get_omac_idx(enum nl80211_iftype type, u64 mask) 143{ 144 int i; 145 146 switch (type) { 147 case NL80211_IFTYPE_MESH_POINT: 148 case NL80211_IFTYPE_ADHOC: 149 case NL80211_IFTYPE_STATION: 150 /* prefer hw bssid slot 1-3 */ 151 i = get_free_idx(mask, HW_BSSID_1, HW_BSSID_3); 152 if (i) 153 return i - 1; 154 155 if (type != NL80211_IFTYPE_STATION) 156 break; 157 158 i = get_free_idx(mask, EXT_BSSID_1, EXT_BSSID_MAX); 159 if (i) 160 return i - 1; 161 162 if (~mask & BIT(HW_BSSID_0)) 163 return HW_BSSID_0; 164 165 break; 166 case NL80211_IFTYPE_MONITOR: 167 case NL80211_IFTYPE_AP: 168 /* ap uses hw bssid 0 and ext bssid */ 169 if (~mask & BIT(HW_BSSID_0)) 170 return HW_BSSID_0; 171 172 i = get_free_idx(mask, EXT_BSSID_1, EXT_BSSID_MAX); 173 if (i) 174 return i - 1; 175 176 break; 177 default: 178 WARN_ON(1); 179 break; 180 } 181 182 return -1; 183} 184 185static void mt7915_init_bitrate_mask(struct ieee80211_vif *vif) 186{ 187 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 188 int i; 189 190 for (i = 0; i < ARRAY_SIZE(mvif->bitrate_mask.control); i++) { 191 mvif->bitrate_mask.control[i].gi = NL80211_TXRATE_DEFAULT_GI; 192 mvif->bitrate_mask.control[i].he_gi = 0xff; 193 mvif->bitrate_mask.control[i].he_ltf = 0xff; 194 mvif->bitrate_mask.control[i].legacy = GENMASK(31, 0); 195 memset(mvif->bitrate_mask.control[i].ht_mcs, 0xff, 196 sizeof(mvif->bitrate_mask.control[i].ht_mcs)); 197 memset(mvif->bitrate_mask.control[i].vht_mcs, 0xff, 198 sizeof(mvif->bitrate_mask.control[i].vht_mcs)); 199 memset(mvif->bitrate_mask.control[i].he_mcs, 0xff, 200 sizeof(mvif->bitrate_mask.control[i].he_mcs)); 201 } 202} 203 204static int mt7915_add_interface(struct ieee80211_hw *hw, 205 struct ieee80211_vif *vif) 206{ 207 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 208 struct mt7915_dev *dev = mt7915_hw_dev(hw); 209 struct mt7915_phy *phy = mt7915_hw_phy(hw); 210 struct mt76_txq *mtxq; 211 bool ext_phy = phy != &dev->phy; 212 int idx, ret = 0; 213 214 mutex_lock(&dev->mt76.mutex); 215 216 mt76_testmode_reset(phy->mt76, true); 217 218 if (vif->type == NL80211_IFTYPE_MONITOR && 219 is_zero_ether_addr(vif->addr)) 220 phy->monitor_vif = vif; 221 222 mvif->mt76.idx = __ffs64(~dev->mt76.vif_mask); 223 if (mvif->mt76.idx >= (MT7915_MAX_INTERFACES << dev->dbdc_support)) { 224 ret = -ENOSPC; 225 goto out; 226 } 227 228 idx = get_omac_idx(vif->type, phy->omac_mask); 229 if (idx < 0) { 230 ret = -ENOSPC; 231 goto out; 232 } 233 mvif->mt76.omac_idx = idx; 234 mvif->phy = phy; 235 mvif->mt76.band_idx = phy->mt76->band_idx; 236 237 mvif->mt76.wmm_idx = vif->type != NL80211_IFTYPE_AP; 238 if (ext_phy) 239 mvif->mt76.wmm_idx += 2; 240 241 ret = mt7915_mcu_add_dev_info(phy, vif, true); 242 if (ret) 243 goto out; 244 245 dev->mt76.vif_mask |= BIT_ULL(mvif->mt76.idx); 246 phy->omac_mask |= BIT_ULL(mvif->mt76.omac_idx); 247 248 idx = MT7915_WTBL_RESERVED - mvif->mt76.idx; 249 250 INIT_LIST_HEAD(&mvif->sta.rc_list); 251 INIT_LIST_HEAD(&mvif->sta.wcid.poll_list); 252 mvif->sta.wcid.idx = idx; 253 mvif->sta.wcid.phy_idx = ext_phy; 254 mvif->sta.wcid.hw_key_idx = -1; 255 mvif->sta.wcid.tx_info |= MT_WCID_TX_INFO_SET; 256 mt76_packet_id_init(&mvif->sta.wcid); 257 258 mt7915_mac_wtbl_update(dev, idx, 259 MT_WTBL_UPDATE_ADM_COUNT_CLEAR); 260 261 if (vif->txq) { 262 mtxq = (struct mt76_txq *)vif->txq->drv_priv; 263 mtxq->wcid = idx; 264 } 265 266 if (vif->type != NL80211_IFTYPE_AP && 267 (!mvif->mt76.omac_idx || mvif->mt76.omac_idx > 3)) 268 vif->offload_flags = 0; 269 vif->offload_flags |= IEEE80211_OFFLOAD_ENCAP_4ADDR; 270 271 mt7915_init_bitrate_mask(vif); 272 memset(&mvif->cap, -1, sizeof(mvif->cap)); 273 274 mt7915_mcu_add_bss_info(phy, vif, true); 275 mt7915_mcu_add_sta(dev, vif, NULL, true); 276 rcu_assign_pointer(dev->mt76.wcid[idx], &mvif->sta.wcid); 277 278out: 279 mutex_unlock(&dev->mt76.mutex); 280 281 return ret; 282} 283 284static void mt7915_remove_interface(struct ieee80211_hw *hw, 285 struct ieee80211_vif *vif) 286{ 287 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 288 struct mt7915_sta *msta = &mvif->sta; 289 struct mt7915_dev *dev = mt7915_hw_dev(hw); 290 struct mt7915_phy *phy = mt7915_hw_phy(hw); 291 int idx = msta->wcid.idx; 292 293 mt7915_mcu_add_bss_info(phy, vif, false); 294 mt7915_mcu_add_sta(dev, vif, NULL, false); 295 296 mutex_lock(&dev->mt76.mutex); 297 mt76_testmode_reset(phy->mt76, true); 298 mutex_unlock(&dev->mt76.mutex); 299 300 if (vif == phy->monitor_vif) 301 phy->monitor_vif = NULL; 302 303 mt7915_mcu_add_dev_info(phy, vif, false); 304 305 rcu_assign_pointer(dev->mt76.wcid[idx], NULL); 306 307 mutex_lock(&dev->mt76.mutex); 308 dev->mt76.vif_mask &= ~BIT_ULL(mvif->mt76.idx); 309 phy->omac_mask &= ~BIT_ULL(mvif->mt76.omac_idx); 310 mutex_unlock(&dev->mt76.mutex); 311 312 spin_lock_bh(&dev->mt76.sta_poll_lock); 313 if (!list_empty(&msta->wcid.poll_list)) 314 list_del_init(&msta->wcid.poll_list); 315 spin_unlock_bh(&dev->mt76.sta_poll_lock); 316 317 mt76_packet_id_flush(&dev->mt76, &msta->wcid); 318} 319 320int mt7915_set_channel(struct mt7915_phy *phy) 321{ 322 struct mt7915_dev *dev = phy->dev; 323 int ret; 324 325 cancel_delayed_work_sync(&phy->mt76->mac_work); 326 327 mutex_lock(&dev->mt76.mutex); 328 set_bit(MT76_RESET, &phy->mt76->state); 329 330 mt76_set_channel(phy->mt76); 331 332 if (dev->flash_mode) { 333 ret = mt7915_mcu_apply_tx_dpd(phy); 334 if (ret) 335 goto out; 336 } 337 338 ret = mt7915_mcu_set_chan_info(phy, MCU_EXT_CMD(CHANNEL_SWITCH)); 339 if (ret) 340 goto out; 341 342 mt7915_mac_set_timing(phy); 343 ret = mt7915_dfs_init_radar_detector(phy); 344 mt7915_mac_cca_stats_reset(phy); 345 346 mt7915_mac_reset_counters(phy); 347 phy->noise = 0; 348 349out: 350 clear_bit(MT76_RESET, &phy->mt76->state); 351 mutex_unlock(&dev->mt76.mutex); 352 353 mt76_txq_schedule_all(phy->mt76); 354 355 if (!mt76_testmode_enabled(phy->mt76)) 356 ieee80211_queue_delayed_work(phy->mt76->hw, 357 &phy->mt76->mac_work, 358 MT7915_WATCHDOG_TIME); 359 360 return ret; 361} 362 363static int mt7915_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd, 364 struct ieee80211_vif *vif, struct ieee80211_sta *sta, 365 struct ieee80211_key_conf *key) 366{ 367 struct mt7915_dev *dev = mt7915_hw_dev(hw); 368 struct mt7915_phy *phy = mt7915_hw_phy(hw); 369 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 370 struct mt7915_sta *msta = sta ? (struct mt7915_sta *)sta->drv_priv : 371 &mvif->sta; 372 struct mt76_wcid *wcid = &msta->wcid; 373 u8 *wcid_keyidx = &wcid->hw_key_idx; 374 int idx = key->keyidx; 375 int err = 0; 376 377 /* The hardware does not support per-STA RX GTK, fallback 378 * to software mode for these. 379 */ 380 if ((vif->type == NL80211_IFTYPE_ADHOC || 381 vif->type == NL80211_IFTYPE_MESH_POINT) && 382 (key->cipher == WLAN_CIPHER_SUITE_TKIP || 383 key->cipher == WLAN_CIPHER_SUITE_CCMP) && 384 !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE)) 385 return -EOPNOTSUPP; 386 387 /* fall back to sw encryption for unsupported ciphers */ 388 switch (key->cipher) { 389 case WLAN_CIPHER_SUITE_AES_CMAC: 390 wcid_keyidx = &wcid->hw_key_idx2; 391 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIE; 392 break; 393 case WLAN_CIPHER_SUITE_TKIP: 394 case WLAN_CIPHER_SUITE_CCMP: 395 case WLAN_CIPHER_SUITE_CCMP_256: 396 case WLAN_CIPHER_SUITE_GCMP: 397 case WLAN_CIPHER_SUITE_GCMP_256: 398 case WLAN_CIPHER_SUITE_SMS4: 399 break; 400 case WLAN_CIPHER_SUITE_WEP40: 401 case WLAN_CIPHER_SUITE_WEP104: 402 default: 403 return -EOPNOTSUPP; 404 } 405 406 mutex_lock(&dev->mt76.mutex); 407 408 if (cmd == SET_KEY && !sta && !mvif->mt76.cipher) { 409 mvif->mt76.cipher = mt76_connac_mcu_get_cipher(key->cipher); 410 mt7915_mcu_add_bss_info(phy, vif, true); 411 } 412 413 if (cmd == SET_KEY) { 414 *wcid_keyidx = idx; 415 } else { 416 if (idx == *wcid_keyidx) 417 *wcid_keyidx = -1; 418 goto out; 419 } 420 421 mt76_wcid_key_setup(&dev->mt76, wcid, key); 422 err = mt76_connac_mcu_add_key(&dev->mt76, vif, &msta->bip, 423 key, MCU_EXT_CMD(STA_REC_UPDATE), 424 &msta->wcid, cmd); 425out: 426 mutex_unlock(&dev->mt76.mutex); 427 428 return err; 429} 430 431static int mt7915_set_sar_specs(struct ieee80211_hw *hw, 432 const struct cfg80211_sar_specs *sar) 433{ 434 struct mt7915_phy *phy = mt7915_hw_phy(hw); 435 struct mt7915_dev *dev = mt7915_hw_dev(hw); 436 int err = -EINVAL; 437 438 mutex_lock(&dev->mt76.mutex); 439 if (!cfg80211_chandef_valid(&phy->mt76->chandef)) 440 goto out; 441 442 err = mt76_init_sar_power(hw, sar); 443 if (err) 444 goto out; 445 446 err = mt7915_mcu_set_txpower_sku(phy); 447out: 448 mutex_unlock(&dev->mt76.mutex); 449 450 return err; 451} 452 453static int mt7915_config(struct ieee80211_hw *hw, u32 changed) 454{ 455 struct mt7915_dev *dev = mt7915_hw_dev(hw); 456 struct mt7915_phy *phy = mt7915_hw_phy(hw); 457 int ret; 458 459 if (changed & IEEE80211_CONF_CHANGE_CHANNEL) { 460#ifdef CONFIG_NL80211_TESTMODE 461 if (phy->mt76->test.state != MT76_TM_STATE_OFF) { 462 mutex_lock(&dev->mt76.mutex); 463 mt76_testmode_reset(phy->mt76, false); 464 mutex_unlock(&dev->mt76.mutex); 465 } 466#endif 467 ieee80211_stop_queues(hw); 468 ret = mt7915_set_channel(phy); 469 if (ret) 470 return ret; 471 ieee80211_wake_queues(hw); 472 } 473 474 if (changed & (IEEE80211_CONF_CHANGE_POWER | 475 IEEE80211_CONF_CHANGE_CHANNEL)) { 476 ret = mt7915_mcu_set_txpower_sku(phy); 477 if (ret) 478 return ret; 479 } 480 481 mutex_lock(&dev->mt76.mutex); 482 483 if (changed & IEEE80211_CONF_CHANGE_MONITOR) { 484 bool enabled = !!(hw->conf.flags & IEEE80211_CONF_MONITOR); 485 bool band = phy->mt76->band_idx; 486 487 if (!enabled) 488 phy->rxfilter |= MT_WF_RFCR_DROP_OTHER_UC; 489 else 490 phy->rxfilter &= ~MT_WF_RFCR_DROP_OTHER_UC; 491 492 mt76_rmw_field(dev, MT_DMA_DCR0(band), MT_DMA_DCR0_RXD_G5_EN, 493 enabled); 494 mt76_testmode_reset(phy->mt76, true); 495 mt76_wr(dev, MT_WF_RFCR(band), phy->rxfilter); 496 } 497 498 mutex_unlock(&dev->mt76.mutex); 499 500 return 0; 501} 502 503static int 504mt7915_conf_tx(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 505 unsigned int link_id, u16 queue, 506 const struct ieee80211_tx_queue_params *params) 507{ 508 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 509 510 /* no need to update right away, we'll get BSS_CHANGED_QOS */ 511 queue = mt76_connac_lmac_mapping(queue); 512 mvif->queue_params[queue] = *params; 513 514 return 0; 515} 516 517static void mt7915_configure_filter(struct ieee80211_hw *hw, 518 unsigned int changed_flags, 519 unsigned int *total_flags, 520 u64 multicast) 521{ 522 struct mt7915_dev *dev = mt7915_hw_dev(hw); 523 struct mt7915_phy *phy = mt7915_hw_phy(hw); 524 bool band = phy->mt76->band_idx; 525 u32 ctl_flags = MT_WF_RFCR1_DROP_ACK | 526 MT_WF_RFCR1_DROP_BF_POLL | 527 MT_WF_RFCR1_DROP_BA | 528 MT_WF_RFCR1_DROP_CFEND | 529 MT_WF_RFCR1_DROP_CFACK; 530 u32 flags = 0; 531 532#define MT76_FILTER(_flag, _hw) do { \ 533 flags |= *total_flags & FIF_##_flag; \ 534 phy->rxfilter &= ~(_hw); \ 535 phy->rxfilter |= !(flags & FIF_##_flag) * (_hw); \ 536 } while (0) 537 538 mutex_lock(&dev->mt76.mutex); 539 540 phy->rxfilter &= ~(MT_WF_RFCR_DROP_OTHER_BSS | 541 MT_WF_RFCR_DROP_OTHER_BEACON | 542 MT_WF_RFCR_DROP_FRAME_REPORT | 543 MT_WF_RFCR_DROP_PROBEREQ | 544 MT_WF_RFCR_DROP_MCAST_FILTERED | 545 MT_WF_RFCR_DROP_MCAST | 546 MT_WF_RFCR_DROP_BCAST | 547 MT_WF_RFCR_DROP_DUPLICATE | 548 MT_WF_RFCR_DROP_A2_BSSID | 549 MT_WF_RFCR_DROP_UNWANTED_CTL | 550 MT_WF_RFCR_DROP_STBC_MULTI); 551 552 MT76_FILTER(OTHER_BSS, MT_WF_RFCR_DROP_OTHER_TIM | 553 MT_WF_RFCR_DROP_A3_MAC | 554 MT_WF_RFCR_DROP_A3_BSSID); 555 556 MT76_FILTER(FCSFAIL, MT_WF_RFCR_DROP_FCSFAIL); 557 558 MT76_FILTER(CONTROL, MT_WF_RFCR_DROP_CTS | 559 MT_WF_RFCR_DROP_RTS | 560 MT_WF_RFCR_DROP_CTL_RSV | 561 MT_WF_RFCR_DROP_NDPA); 562 563 *total_flags = flags; 564 mt76_wr(dev, MT_WF_RFCR(band), phy->rxfilter); 565 566 if (*total_flags & FIF_CONTROL) 567 mt76_clear(dev, MT_WF_RFCR1(band), ctl_flags); 568 else 569 mt76_set(dev, MT_WF_RFCR1(band), ctl_flags); 570 571 mutex_unlock(&dev->mt76.mutex); 572} 573 574static void 575mt7915_update_bss_color(struct ieee80211_hw *hw, 576 struct ieee80211_vif *vif, 577 struct cfg80211_he_bss_color *bss_color) 578{ 579 struct mt7915_dev *dev = mt7915_hw_dev(hw); 580 581 switch (vif->type) { 582 case NL80211_IFTYPE_AP: { 583 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 584 585 if (mvif->mt76.omac_idx > HW_BSSID_MAX) 586 return; 587 fallthrough; 588 } 589 case NL80211_IFTYPE_STATION: 590 mt7915_mcu_update_bss_color(dev, vif, bss_color); 591 break; 592 default: 593 break; 594 } 595} 596 597static void mt7915_bss_info_changed(struct ieee80211_hw *hw, 598 struct ieee80211_vif *vif, 599 struct ieee80211_bss_conf *info, 600 u64 changed) 601{ 602 struct mt7915_phy *phy = mt7915_hw_phy(hw); 603 struct mt7915_dev *dev = mt7915_hw_dev(hw); 604 int set_bss_info = -1, set_sta = -1; 605 606 mutex_lock(&dev->mt76.mutex); 607 608 /* 609 * station mode uses BSSID to map the wlan entry to a peer, 610 * and then peer references bss_info_rfch to set bandwidth cap. 611 */ 612 if (changed & BSS_CHANGED_BSSID && 613 vif->type == NL80211_IFTYPE_STATION) 614 set_bss_info = set_sta = !is_zero_ether_addr(info->bssid); 615 if (changed & BSS_CHANGED_ASSOC) 616 set_bss_info = vif->cfg.assoc; 617 if (changed & BSS_CHANGED_BEACON_ENABLED && 618 vif->type != NL80211_IFTYPE_AP) 619 set_bss_info = set_sta = info->enable_beacon; 620 621 if (set_bss_info == 1) 622 mt7915_mcu_add_bss_info(phy, vif, true); 623 if (set_sta == 1) 624 mt7915_mcu_add_sta(dev, vif, NULL, true); 625 626 if (changed & BSS_CHANGED_ERP_CTS_PROT) 627 mt7915_mac_enable_rtscts(dev, vif, info->use_cts_prot); 628 629 if (changed & BSS_CHANGED_ERP_SLOT) { 630 int slottime = info->use_short_slot ? 9 : 20; 631 632 if (slottime != phy->slottime) { 633 phy->slottime = slottime; 634 mt7915_mac_set_timing(phy); 635 } 636 } 637 638 /* ensure that enable txcmd_mode after bss_info */ 639 if (changed & (BSS_CHANGED_QOS | BSS_CHANGED_BEACON_ENABLED)) 640 mt7915_mcu_set_tx(dev, vif); 641 642 if (changed & BSS_CHANGED_HE_OBSS_PD) 643 mt7915_mcu_add_obss_spr(phy, vif, &info->he_obss_pd); 644 645 if (changed & BSS_CHANGED_HE_BSS_COLOR) 646 mt7915_update_bss_color(hw, vif, &info->he_bss_color); 647 648 if (changed & (BSS_CHANGED_BEACON | 649 BSS_CHANGED_BEACON_ENABLED)) 650 mt7915_mcu_add_beacon(hw, vif, info->enable_beacon, changed); 651 652 if (changed & (BSS_CHANGED_UNSOL_BCAST_PROBE_RESP | 653 BSS_CHANGED_FILS_DISCOVERY)) 654 mt7915_mcu_add_inband_discov(dev, vif, changed); 655 656 if (set_bss_info == 0) 657 mt7915_mcu_add_bss_info(phy, vif, false); 658 if (set_sta == 0) 659 mt7915_mcu_add_sta(dev, vif, NULL, false); 660 661 mutex_unlock(&dev->mt76.mutex); 662} 663 664static void 665mt7915_vif_check_caps(struct mt7915_phy *phy, struct ieee80211_vif *vif) 666{ 667 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 668 struct mt7915_vif_cap *vc = &mvif->cap; 669 670 vc->ht_ldpc = vif->bss_conf.ht_ldpc; 671 vc->vht_ldpc = vif->bss_conf.vht_ldpc; 672 vc->vht_su_ebfer = vif->bss_conf.vht_su_beamformer; 673 vc->vht_su_ebfee = vif->bss_conf.vht_su_beamformee; 674 vc->vht_mu_ebfer = vif->bss_conf.vht_mu_beamformer; 675 vc->vht_mu_ebfee = vif->bss_conf.vht_mu_beamformee; 676 vc->he_ldpc = vif->bss_conf.he_ldpc; 677 vc->he_su_ebfer = vif->bss_conf.he_su_beamformer; 678 vc->he_su_ebfee = vif->bss_conf.he_su_beamformee; 679 vc->he_mu_ebfer = vif->bss_conf.he_mu_beamformer; 680} 681 682static int 683mt7915_start_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 684 struct ieee80211_bss_conf *link_conf) 685{ 686 struct mt7915_phy *phy = mt7915_hw_phy(hw); 687 struct mt7915_dev *dev = mt7915_hw_dev(hw); 688 int err; 689 690 mutex_lock(&dev->mt76.mutex); 691 692 mt7915_vif_check_caps(phy, vif); 693 694 err = mt7915_mcu_add_bss_info(phy, vif, true); 695 if (err) 696 goto out; 697 err = mt7915_mcu_add_sta(dev, vif, NULL, true); 698out: 699 mutex_unlock(&dev->mt76.mutex); 700 701 return err; 702} 703 704static void 705mt7915_stop_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 706 struct ieee80211_bss_conf *link_conf) 707{ 708 struct mt7915_dev *dev = mt7915_hw_dev(hw); 709 710 mutex_lock(&dev->mt76.mutex); 711 mt7915_mcu_add_sta(dev, vif, NULL, false); 712 mutex_unlock(&dev->mt76.mutex); 713} 714 715static void 716mt7915_channel_switch_beacon(struct ieee80211_hw *hw, 717 struct ieee80211_vif *vif, 718 struct cfg80211_chan_def *chandef) 719{ 720 struct mt7915_dev *dev = mt7915_hw_dev(hw); 721 722 mutex_lock(&dev->mt76.mutex); 723 mt7915_mcu_add_beacon(hw, vif, true, BSS_CHANGED_BEACON); 724 mutex_unlock(&dev->mt76.mutex); 725} 726 727int mt7915_mac_sta_add(struct mt76_dev *mdev, struct ieee80211_vif *vif, 728 struct ieee80211_sta *sta) 729{ 730 struct mt7915_dev *dev = container_of(mdev, struct mt7915_dev, mt76); 731 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 732 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 733 bool ext_phy = mvif->phy != &dev->phy; 734 int ret, idx; 735 736 idx = mt76_wcid_alloc(dev->mt76.wcid_mask, MT7915_WTBL_STA); 737 if (idx < 0) 738 return -ENOSPC; 739 740 INIT_LIST_HEAD(&msta->rc_list); 741 INIT_LIST_HEAD(&msta->wcid.poll_list); 742 msta->vif = mvif; 743 msta->wcid.sta = 1; 744 msta->wcid.idx = idx; 745 msta->wcid.phy_idx = ext_phy; 746 msta->wcid.tx_info |= MT_WCID_TX_INFO_SET; 747 msta->jiffies = jiffies; 748 749 ewma_avg_signal_init(&msta->avg_ack_signal); 750 751 mt7915_mac_wtbl_update(dev, idx, 752 MT_WTBL_UPDATE_ADM_COUNT_CLEAR); 753 754 ret = mt7915_mcu_add_sta(dev, vif, sta, true); 755 if (ret) 756 return ret; 757 758 return mt7915_mcu_add_rate_ctrl(dev, vif, sta, false); 759} 760 761void mt7915_mac_sta_remove(struct mt76_dev *mdev, struct ieee80211_vif *vif, 762 struct ieee80211_sta *sta) 763{ 764 struct mt7915_dev *dev = container_of(mdev, struct mt7915_dev, mt76); 765 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 766 int i; 767 768 mt7915_mcu_add_sta(dev, vif, sta, false); 769 770 mt7915_mac_wtbl_update(dev, msta->wcid.idx, 771 MT_WTBL_UPDATE_ADM_COUNT_CLEAR); 772 773 for (i = 0; i < ARRAY_SIZE(msta->twt.flow); i++) 774 mt7915_mac_twt_teardown_flow(dev, msta, i); 775 776 spin_lock_bh(&mdev->sta_poll_lock); 777 if (!list_empty(&msta->wcid.poll_list)) 778 list_del_init(&msta->wcid.poll_list); 779 if (!list_empty(&msta->rc_list)) 780 list_del_init(&msta->rc_list); 781 spin_unlock_bh(&mdev->sta_poll_lock); 782} 783 784static void mt7915_tx(struct ieee80211_hw *hw, 785 struct ieee80211_tx_control *control, 786 struct sk_buff *skb) 787{ 788 struct mt7915_dev *dev = mt7915_hw_dev(hw); 789 struct mt76_phy *mphy = hw->priv; 790 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 791 struct ieee80211_vif *vif = info->control.vif; 792 struct mt76_wcid *wcid = &dev->mt76.global_wcid; 793 794 if (control->sta) { 795 struct mt7915_sta *sta; 796 797 sta = (struct mt7915_sta *)control->sta->drv_priv; 798 wcid = &sta->wcid; 799 } 800 801 if (vif && !control->sta) { 802 struct mt7915_vif *mvif; 803 804 mvif = (struct mt7915_vif *)vif->drv_priv; 805 wcid = &mvif->sta.wcid; 806 } 807 808 mt76_tx(mphy, control->sta, wcid, skb); 809} 810 811static int mt7915_set_rts_threshold(struct ieee80211_hw *hw, u32 val) 812{ 813 struct mt7915_dev *dev = mt7915_hw_dev(hw); 814 struct mt7915_phy *phy = mt7915_hw_phy(hw); 815 int ret; 816 817 mutex_lock(&dev->mt76.mutex); 818 ret = mt76_connac_mcu_set_rts_thresh(&dev->mt76, val, 819 phy->mt76->band_idx); 820 mutex_unlock(&dev->mt76.mutex); 821 822 return ret; 823} 824 825static int 826mt7915_ampdu_action(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 827 struct ieee80211_ampdu_params *params) 828{ 829 enum ieee80211_ampdu_mlme_action action = params->action; 830 struct mt7915_dev *dev = mt7915_hw_dev(hw); 831 struct ieee80211_sta *sta = params->sta; 832 struct ieee80211_txq *txq = sta->txq[params->tid]; 833 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 834 u16 tid = params->tid; 835 u16 ssn = params->ssn; 836 struct mt76_txq *mtxq; 837 int ret = 0; 838 839 if (!txq) 840 return -EINVAL; 841 842 mtxq = (struct mt76_txq *)txq->drv_priv; 843 844 mutex_lock(&dev->mt76.mutex); 845 switch (action) { 846 case IEEE80211_AMPDU_RX_START: 847 mt76_rx_aggr_start(&dev->mt76, &msta->wcid, tid, ssn, 848 params->buf_size); 849 ret = mt7915_mcu_add_rx_ba(dev, params, true); 850 break; 851 case IEEE80211_AMPDU_RX_STOP: 852 mt76_rx_aggr_stop(&dev->mt76, &msta->wcid, tid); 853 ret = mt7915_mcu_add_rx_ba(dev, params, false); 854 break; 855 case IEEE80211_AMPDU_TX_OPERATIONAL: 856 mtxq->aggr = true; 857 mtxq->send_bar = false; 858 ret = mt7915_mcu_add_tx_ba(dev, params, true); 859 break; 860 case IEEE80211_AMPDU_TX_STOP_FLUSH: 861 case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT: 862 mtxq->aggr = false; 863 clear_bit(tid, &msta->wcid.ampdu_state); 864 ret = mt7915_mcu_add_tx_ba(dev, params, false); 865 break; 866 case IEEE80211_AMPDU_TX_START: 867 set_bit(tid, &msta->wcid.ampdu_state); 868 ret = IEEE80211_AMPDU_TX_START_IMMEDIATE; 869 break; 870 case IEEE80211_AMPDU_TX_STOP_CONT: 871 mtxq->aggr = false; 872 clear_bit(tid, &msta->wcid.ampdu_state); 873 ret = mt7915_mcu_add_tx_ba(dev, params, false); 874 ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid); 875 break; 876 } 877 mutex_unlock(&dev->mt76.mutex); 878 879 return ret; 880} 881 882static int 883mt7915_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 884 struct ieee80211_sta *sta) 885{ 886 return mt76_sta_state(hw, vif, sta, IEEE80211_STA_NOTEXIST, 887 IEEE80211_STA_NONE); 888} 889 890static int 891mt7915_sta_remove(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 892 struct ieee80211_sta *sta) 893{ 894 return mt76_sta_state(hw, vif, sta, IEEE80211_STA_NONE, 895 IEEE80211_STA_NOTEXIST); 896} 897 898static int 899mt7915_get_stats(struct ieee80211_hw *hw, 900 struct ieee80211_low_level_stats *stats) 901{ 902 struct mt7915_phy *phy = mt7915_hw_phy(hw); 903 struct mt7915_dev *dev = mt7915_hw_dev(hw); 904 struct mt76_mib_stats *mib = &phy->mib; 905 906 mutex_lock(&dev->mt76.mutex); 907 908 stats->dot11RTSSuccessCount = mib->rts_cnt; 909 stats->dot11RTSFailureCount = mib->rts_retries_cnt; 910 stats->dot11FCSErrorCount = mib->fcs_err_cnt; 911 stats->dot11ACKFailureCount = mib->ack_fail_cnt; 912 913 mutex_unlock(&dev->mt76.mutex); 914 915 return 0; 916} 917 918u64 __mt7915_get_tsf(struct ieee80211_hw *hw, struct mt7915_vif *mvif) 919{ 920 struct mt7915_dev *dev = mt7915_hw_dev(hw); 921 struct mt7915_phy *phy = mt7915_hw_phy(hw); 922 bool band = phy->mt76->band_idx; 923 union { 924 u64 t64; 925 u32 t32[2]; 926 } tsf; 927 u16 n; 928 929 lockdep_assert_held(&dev->mt76.mutex); 930 931 n = mvif->mt76.omac_idx > HW_BSSID_MAX ? HW_BSSID_0 932 : mvif->mt76.omac_idx; 933 /* TSF software read */ 934 if (is_mt7915(&dev->mt76)) 935 mt76_rmw(dev, MT_LPON_TCR(band, n), MT_LPON_TCR_SW_MODE, 936 MT_LPON_TCR_SW_READ); 937 else 938 mt76_rmw(dev, MT_LPON_TCR_MT7916(band, n), MT_LPON_TCR_SW_MODE, 939 MT_LPON_TCR_SW_READ); 940 tsf.t32[0] = mt76_rr(dev, MT_LPON_UTTR0(band)); 941 tsf.t32[1] = mt76_rr(dev, MT_LPON_UTTR1(band)); 942 943 return tsf.t64; 944} 945 946static u64 947mt7915_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif) 948{ 949 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 950 struct mt7915_dev *dev = mt7915_hw_dev(hw); 951 u64 ret; 952 953 mutex_lock(&dev->mt76.mutex); 954 ret = __mt7915_get_tsf(hw, mvif); 955 mutex_unlock(&dev->mt76.mutex); 956 957 return ret; 958} 959 960static void 961mt7915_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 962 u64 timestamp) 963{ 964 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 965 struct mt7915_dev *dev = mt7915_hw_dev(hw); 966 struct mt7915_phy *phy = mt7915_hw_phy(hw); 967 bool band = phy->mt76->band_idx; 968 union { 969 u64 t64; 970 u32 t32[2]; 971 } tsf = { .t64 = timestamp, }; 972 u16 n; 973 974 mutex_lock(&dev->mt76.mutex); 975 976 n = mvif->mt76.omac_idx > HW_BSSID_MAX ? HW_BSSID_0 977 : mvif->mt76.omac_idx; 978 mt76_wr(dev, MT_LPON_UTTR0(band), tsf.t32[0]); 979 mt76_wr(dev, MT_LPON_UTTR1(band), tsf.t32[1]); 980 /* TSF software overwrite */ 981 if (is_mt7915(&dev->mt76)) 982 mt76_rmw(dev, MT_LPON_TCR(band, n), MT_LPON_TCR_SW_MODE, 983 MT_LPON_TCR_SW_WRITE); 984 else 985 mt76_rmw(dev, MT_LPON_TCR_MT7916(band, n), MT_LPON_TCR_SW_MODE, 986 MT_LPON_TCR_SW_WRITE); 987 988 mutex_unlock(&dev->mt76.mutex); 989} 990 991static void 992mt7915_offset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 993 s64 timestamp) 994{ 995 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 996 struct mt7915_dev *dev = mt7915_hw_dev(hw); 997 struct mt7915_phy *phy = mt7915_hw_phy(hw); 998 bool band = phy->mt76->band_idx; 999 union { 1000 u64 t64; 1001 u32 t32[2]; 1002 } tsf = { .t64 = timestamp, }; 1003 u16 n; 1004 1005 mutex_lock(&dev->mt76.mutex); 1006 1007 n = mvif->mt76.omac_idx > HW_BSSID_MAX ? HW_BSSID_0 1008 : mvif->mt76.omac_idx; 1009 mt76_wr(dev, MT_LPON_UTTR0(band), tsf.t32[0]); 1010 mt76_wr(dev, MT_LPON_UTTR1(band), tsf.t32[1]); 1011 /* TSF software adjust*/ 1012 if (is_mt7915(&dev->mt76)) 1013 mt76_rmw(dev, MT_LPON_TCR(band, n), MT_LPON_TCR_SW_MODE, 1014 MT_LPON_TCR_SW_ADJUST); 1015 else 1016 mt76_rmw(dev, MT_LPON_TCR_MT7916(band, n), MT_LPON_TCR_SW_MODE, 1017 MT_LPON_TCR_SW_ADJUST); 1018 1019 mutex_unlock(&dev->mt76.mutex); 1020} 1021 1022static void 1023mt7915_set_coverage_class(struct ieee80211_hw *hw, s16 coverage_class) 1024{ 1025 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1026 struct mt7915_dev *dev = phy->dev; 1027 1028 mutex_lock(&dev->mt76.mutex); 1029 phy->coverage_class = max_t(s16, coverage_class, 0); 1030 mt7915_mac_set_timing(phy); 1031 mutex_unlock(&dev->mt76.mutex); 1032} 1033 1034static int 1035mt7915_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant) 1036{ 1037 struct mt7915_dev *dev = mt7915_hw_dev(hw); 1038 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1039 int max_nss = hweight8(hw->wiphy->available_antennas_tx); 1040 u8 chainshift = dev->chainshift; 1041 u8 band = phy->mt76->band_idx; 1042 1043 if (!tx_ant || tx_ant != rx_ant || ffs(tx_ant) > max_nss) 1044 return -EINVAL; 1045 1046 mutex_lock(&dev->mt76.mutex); 1047 1048 phy->mt76->antenna_mask = tx_ant; 1049 1050 /* handle a variant of mt7916/mt7981 which has 3T3R but nss2 on 5 GHz band */ 1051 if ((is_mt7916(&dev->mt76) || is_mt7981(&dev->mt76)) && 1052 band && hweight8(tx_ant) == max_nss) 1053 phy->mt76->chainmask = (dev->chainmask >> chainshift) << chainshift; 1054 else 1055 phy->mt76->chainmask = tx_ant << (chainshift * band); 1056 1057 mt76_set_stream_caps(phy->mt76, true); 1058 mt7915_set_stream_vht_txbf_caps(phy); 1059 mt7915_set_stream_he_caps(phy); 1060 1061 mutex_unlock(&dev->mt76.mutex); 1062 1063 return 0; 1064} 1065 1066static void mt7915_sta_statistics(struct ieee80211_hw *hw, 1067 struct ieee80211_vif *vif, 1068 struct ieee80211_sta *sta, 1069 struct station_info *sinfo) 1070{ 1071 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1072 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 1073 struct rate_info *txrate = &msta->wcid.rate; 1074 struct rate_info rxrate = {}; 1075 1076 if (is_mt7915(&phy->dev->mt76) && 1077 !mt7915_mcu_get_rx_rate(phy, vif, sta, &rxrate)) { 1078 sinfo->rxrate = rxrate; 1079 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_BITRATE); 1080 } 1081 1082 if (txrate->legacy || txrate->flags) { 1083 if (txrate->legacy) { 1084 sinfo->txrate.legacy = txrate->legacy; 1085 } else { 1086 sinfo->txrate.mcs = txrate->mcs; 1087 sinfo->txrate.nss = txrate->nss; 1088 sinfo->txrate.bw = txrate->bw; 1089 sinfo->txrate.he_gi = txrate->he_gi; 1090 sinfo->txrate.he_dcm = txrate->he_dcm; 1091 sinfo->txrate.he_ru_alloc = txrate->he_ru_alloc; 1092 } 1093 sinfo->txrate.flags = txrate->flags; 1094 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE); 1095 } 1096 1097 /* offloading flows bypass networking stack, so driver counts and 1098 * reports sta statistics via NL80211_STA_INFO when WED is active. 1099 */ 1100 if (mtk_wed_device_active(&phy->dev->mt76.mmio.wed)) { 1101 sinfo->tx_bytes = msta->wcid.stats.tx_bytes; 1102 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BYTES64); 1103 1104 if (!mt7915_mcu_wed_wa_tx_stats(phy->dev, msta->wcid.idx)) { 1105 sinfo->tx_packets = msta->wcid.stats.tx_packets; 1106 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_PACKETS); 1107 } 1108 1109 if (mtk_wed_get_rx_capa(&phy->dev->mt76.mmio.wed)) { 1110 sinfo->rx_bytes = msta->wcid.stats.rx_bytes; 1111 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_BYTES64); 1112 1113 sinfo->rx_packets = msta->wcid.stats.rx_packets; 1114 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_PACKETS); 1115 } 1116 } 1117 1118 sinfo->tx_failed = msta->wcid.stats.tx_failed; 1119 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_FAILED); 1120 1121 sinfo->tx_retries = msta->wcid.stats.tx_retries; 1122 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_RETRIES); 1123 1124 sinfo->ack_signal = (s8)msta->ack_signal; 1125 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_ACK_SIGNAL); 1126 1127 sinfo->avg_ack_signal = -(s8)ewma_avg_signal_read(&msta->avg_ack_signal); 1128 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_ACK_SIGNAL_AVG); 1129} 1130 1131static void mt7915_sta_rc_work(void *data, struct ieee80211_sta *sta) 1132{ 1133 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 1134 struct mt7915_dev *dev = msta->vif->phy->dev; 1135 u32 *changed = data; 1136 1137 spin_lock_bh(&dev->mt76.sta_poll_lock); 1138 msta->changed |= *changed; 1139 if (list_empty(&msta->rc_list)) 1140 list_add_tail(&msta->rc_list, &dev->sta_rc_list); 1141 spin_unlock_bh(&dev->mt76.sta_poll_lock); 1142} 1143 1144static void mt7915_sta_rc_update(struct ieee80211_hw *hw, 1145 struct ieee80211_vif *vif, 1146 struct ieee80211_sta *sta, 1147 u32 changed) 1148{ 1149 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1150 struct mt7915_dev *dev = phy->dev; 1151 1152 mt7915_sta_rc_work(&changed, sta); 1153 ieee80211_queue_work(hw, &dev->rc_work); 1154} 1155 1156static int 1157mt7915_set_bitrate_mask(struct ieee80211_hw *hw, struct ieee80211_vif *vif, 1158 const struct cfg80211_bitrate_mask *mask) 1159{ 1160 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 1161 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1162 struct mt7915_dev *dev = phy->dev; 1163 u32 changed = IEEE80211_RC_SUPP_RATES_CHANGED; 1164 1165 mvif->bitrate_mask = *mask; 1166 1167 /* if multiple rates across different preambles are given we can 1168 * reconfigure this info with all peers using sta_rec command with 1169 * the below exception cases. 1170 * - single rate : if a rate is passed along with different preambles, 1171 * we select the highest one as fixed rate. i.e VHT MCS for VHT peers. 1172 * - multiple rates: if it's not in range format i.e 0-{7,8,9} for VHT 1173 * then multiple MCS setting (MCS 4,5,6) is not supported. 1174 */ 1175 ieee80211_iterate_stations_atomic(hw, mt7915_sta_rc_work, &changed); 1176 ieee80211_queue_work(hw, &dev->rc_work); 1177 1178 return 0; 1179} 1180 1181static void mt7915_sta_set_4addr(struct ieee80211_hw *hw, 1182 struct ieee80211_vif *vif, 1183 struct ieee80211_sta *sta, 1184 bool enabled) 1185{ 1186 struct mt7915_dev *dev = mt7915_hw_dev(hw); 1187 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 1188 1189 if (enabled) 1190 set_bit(MT_WCID_FLAG_4ADDR, &msta->wcid.flags); 1191 else 1192 clear_bit(MT_WCID_FLAG_4ADDR, &msta->wcid.flags); 1193 1194 mt76_connac_mcu_wtbl_update_hdr_trans(&dev->mt76, vif, sta); 1195} 1196 1197static void mt7915_sta_set_decap_offload(struct ieee80211_hw *hw, 1198 struct ieee80211_vif *vif, 1199 struct ieee80211_sta *sta, 1200 bool enabled) 1201{ 1202 struct mt7915_dev *dev = mt7915_hw_dev(hw); 1203 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 1204 1205 if (enabled) 1206 set_bit(MT_WCID_FLAG_HDR_TRANS, &msta->wcid.flags); 1207 else 1208 clear_bit(MT_WCID_FLAG_HDR_TRANS, &msta->wcid.flags); 1209 1210 mt76_connac_mcu_wtbl_update_hdr_trans(&dev->mt76, vif, sta); 1211} 1212 1213static int mt7915_sta_set_txpwr(struct ieee80211_hw *hw, 1214 struct ieee80211_vif *vif, 1215 struct ieee80211_sta *sta) 1216{ 1217 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1218 struct mt7915_dev *dev = mt7915_hw_dev(hw); 1219 s16 txpower = sta->deflink.txpwr.power; 1220 int ret; 1221 1222 if (sta->deflink.txpwr.type == NL80211_TX_POWER_AUTOMATIC) 1223 txpower = 0; 1224 1225 mutex_lock(&dev->mt76.mutex); 1226 1227 /* NOTE: temporarily use 0 as minimum limit, which is a 1228 * global setting and will be applied to all stations. 1229 */ 1230 ret = mt7915_mcu_set_txpower_frame_min(phy, 0); 1231 if (ret) 1232 goto out; 1233 1234 /* This only applies to data frames while pushing traffic, 1235 * whereas the management frames or other packets that are 1236 * using fixed rate can be configured via TxD. 1237 */ 1238 ret = mt7915_mcu_set_txpower_frame(phy, vif, sta, txpower); 1239 1240out: 1241 mutex_unlock(&dev->mt76.mutex); 1242 1243 return ret; 1244} 1245 1246static const char mt7915_gstrings_stats[][ETH_GSTRING_LEN] = { 1247 "tx_ampdu_cnt", 1248 "tx_stop_q_empty_cnt", 1249 "tx_mpdu_attempts", 1250 "tx_mpdu_success", 1251 "tx_rwp_fail_cnt", 1252 "tx_rwp_need_cnt", 1253 "tx_pkt_ebf_cnt", 1254 "tx_pkt_ibf_cnt", 1255 "tx_ampdu_len:0-1", 1256 "tx_ampdu_len:2-10", 1257 "tx_ampdu_len:11-19", 1258 "tx_ampdu_len:20-28", 1259 "tx_ampdu_len:29-37", 1260 "tx_ampdu_len:38-46", 1261 "tx_ampdu_len:47-55", 1262 "tx_ampdu_len:56-79", 1263 "tx_ampdu_len:80-103", 1264 "tx_ampdu_len:104-127", 1265 "tx_ampdu_len:128-151", 1266 "tx_ampdu_len:152-175", 1267 "tx_ampdu_len:176-199", 1268 "tx_ampdu_len:200-223", 1269 "tx_ampdu_len:224-247", 1270 "ba_miss_count", 1271 "tx_beamformer_ppdu_iBF", 1272 "tx_beamformer_ppdu_eBF", 1273 "tx_beamformer_rx_feedback_all", 1274 "tx_beamformer_rx_feedback_he", 1275 "tx_beamformer_rx_feedback_vht", 1276 "tx_beamformer_rx_feedback_ht", 1277 "tx_beamformer_rx_feedback_bw", /* zero based idx: 20, 40, 80, 160 */ 1278 "tx_beamformer_rx_feedback_nc", 1279 "tx_beamformer_rx_feedback_nr", 1280 "tx_beamformee_ok_feedback_pkts", 1281 "tx_beamformee_feedback_trig", 1282 "tx_mu_beamforming", 1283 "tx_mu_mpdu", 1284 "tx_mu_successful_mpdu", 1285 "tx_su_successful_mpdu", 1286 "tx_msdu_pack_1", 1287 "tx_msdu_pack_2", 1288 "tx_msdu_pack_3", 1289 "tx_msdu_pack_4", 1290 "tx_msdu_pack_5", 1291 "tx_msdu_pack_6", 1292 "tx_msdu_pack_7", 1293 "tx_msdu_pack_8", 1294 1295 /* rx counters */ 1296 "rx_fifo_full_cnt", 1297 "rx_mpdu_cnt", 1298 "channel_idle_cnt", 1299 "primary_cca_busy_time", 1300 "secondary_cca_busy_time", 1301 "primary_energy_detect_time", 1302 "cck_mdrdy_time", 1303 "ofdm_mdrdy_time", 1304 "green_mdrdy_time", 1305 "rx_vector_mismatch_cnt", 1306 "rx_delimiter_fail_cnt", 1307 "rx_mrdy_cnt", 1308 "rx_len_mismatch_cnt", 1309 "rx_ampdu_cnt", 1310 "rx_ampdu_bytes_cnt", 1311 "rx_ampdu_valid_subframe_cnt", 1312 "rx_ampdu_valid_subframe_b_cnt", 1313 "rx_pfdrop_cnt", 1314 "rx_vec_queue_overflow_drop_cnt", 1315 "rx_ba_cnt", 1316 1317 /* muru mu-mimo and ofdma related stats */ 1318 "dl_cck_cnt", 1319 "dl_ofdm_cnt", 1320 "dl_htmix_cnt", 1321 "dl_htgf_cnt", 1322 "dl_vht_su_cnt", 1323 "dl_vht_2mu_cnt", 1324 "dl_vht_3mu_cnt", 1325 "dl_vht_4mu_cnt", 1326 "dl_he_su_cnt", 1327 "dl_he_ext_su_cnt", 1328 "dl_he_2ru_cnt", 1329 "dl_he_2mu_cnt", 1330 "dl_he_3ru_cnt", 1331 "dl_he_3mu_cnt", 1332 "dl_he_4ru_cnt", 1333 "dl_he_4mu_cnt", 1334 "dl_he_5to8ru_cnt", 1335 "dl_he_9to16ru_cnt", 1336 "dl_he_gtr16ru_cnt", 1337 1338 "ul_hetrig_su_cnt", 1339 "ul_hetrig_2ru_cnt", 1340 "ul_hetrig_3ru_cnt", 1341 "ul_hetrig_4ru_cnt", 1342 "ul_hetrig_5to8ru_cnt", 1343 "ul_hetrig_9to16ru_cnt", 1344 "ul_hetrig_gtr16ru_cnt", 1345 "ul_hetrig_2mu_cnt", 1346 "ul_hetrig_3mu_cnt", 1347 "ul_hetrig_4mu_cnt", 1348 1349 /* per vif counters */ 1350 "v_tx_mode_cck", 1351 "v_tx_mode_ofdm", 1352 "v_tx_mode_ht", 1353 "v_tx_mode_ht_gf", 1354 "v_tx_mode_vht", 1355 "v_tx_mode_he_su", 1356 "v_tx_mode_he_ext_su", 1357 "v_tx_mode_he_tb", 1358 "v_tx_mode_he_mu", 1359 "v_tx_bw_20", 1360 "v_tx_bw_40", 1361 "v_tx_bw_80", 1362 "v_tx_bw_160", 1363 "v_tx_mcs_0", 1364 "v_tx_mcs_1", 1365 "v_tx_mcs_2", 1366 "v_tx_mcs_3", 1367 "v_tx_mcs_4", 1368 "v_tx_mcs_5", 1369 "v_tx_mcs_6", 1370 "v_tx_mcs_7", 1371 "v_tx_mcs_8", 1372 "v_tx_mcs_9", 1373 "v_tx_mcs_10", 1374 "v_tx_mcs_11", 1375 "v_tx_nss_1", 1376 "v_tx_nss_2", 1377 "v_tx_nss_3", 1378 "v_tx_nss_4", 1379}; 1380 1381#define MT7915_SSTATS_LEN ARRAY_SIZE(mt7915_gstrings_stats) 1382 1383/* Ethtool related API */ 1384static 1385void mt7915_get_et_strings(struct ieee80211_hw *hw, 1386 struct ieee80211_vif *vif, 1387 u32 sset, u8 *data) 1388{ 1389 if (sset != ETH_SS_STATS) 1390 return; 1391 1392 memcpy(data, mt7915_gstrings_stats, sizeof(mt7915_gstrings_stats)); 1393 data += sizeof(mt7915_gstrings_stats); 1394 page_pool_ethtool_stats_get_strings(data); 1395} 1396 1397static 1398int mt7915_get_et_sset_count(struct ieee80211_hw *hw, 1399 struct ieee80211_vif *vif, int sset) 1400{ 1401 if (sset != ETH_SS_STATS) 1402 return 0; 1403 1404 return MT7915_SSTATS_LEN + page_pool_ethtool_stats_get_count(); 1405} 1406 1407static void mt7915_ethtool_worker(void *wi_data, struct ieee80211_sta *sta) 1408{ 1409 struct mt76_ethtool_worker_info *wi = wi_data; 1410 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 1411 1412 if (msta->vif->mt76.idx != wi->idx) 1413 return; 1414 1415 mt76_ethtool_worker(wi, &msta->wcid.stats, false); 1416} 1417 1418static 1419void mt7915_get_et_stats(struct ieee80211_hw *hw, 1420 struct ieee80211_vif *vif, 1421 struct ethtool_stats *stats, u64 *data) 1422{ 1423 struct mt7915_dev *dev = mt7915_hw_dev(hw); 1424 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1425 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 1426 struct mt76_mib_stats *mib = &phy->mib; 1427 struct mt76_ethtool_worker_info wi = { 1428 .data = data, 1429 .idx = mvif->mt76.idx, 1430 }; 1431 /* See mt7915_ampdu_stat_read_phy, etc */ 1432 int i, ei = 0, stats_size; 1433 1434 mutex_lock(&dev->mt76.mutex); 1435 1436 mt7915_mac_update_stats(phy); 1437 1438 data[ei++] = mib->tx_ampdu_cnt; 1439 data[ei++] = mib->tx_stop_q_empty_cnt; 1440 data[ei++] = mib->tx_mpdu_attempts_cnt; 1441 data[ei++] = mib->tx_mpdu_success_cnt; 1442 data[ei++] = mib->tx_rwp_fail_cnt; 1443 data[ei++] = mib->tx_rwp_need_cnt; 1444 data[ei++] = mib->tx_pkt_ebf_cnt; 1445 data[ei++] = mib->tx_pkt_ibf_cnt; 1446 1447 /* Tx ampdu stat */ 1448 for (i = 0; i < 15 /*ARRAY_SIZE(bound)*/; i++) 1449 data[ei++] = phy->mt76->aggr_stats[i]; 1450 1451 data[ei++] = phy->mib.ba_miss_cnt; 1452 1453 /* Tx Beamformer monitor */ 1454 data[ei++] = mib->tx_bf_ibf_ppdu_cnt; 1455 data[ei++] = mib->tx_bf_ebf_ppdu_cnt; 1456 1457 /* Tx Beamformer Rx feedback monitor */ 1458 data[ei++] = mib->tx_bf_rx_fb_all_cnt; 1459 data[ei++] = mib->tx_bf_rx_fb_he_cnt; 1460 data[ei++] = mib->tx_bf_rx_fb_vht_cnt; 1461 data[ei++] = mib->tx_bf_rx_fb_ht_cnt; 1462 1463 data[ei++] = mib->tx_bf_rx_fb_bw; 1464 data[ei++] = mib->tx_bf_rx_fb_nc_cnt; 1465 data[ei++] = mib->tx_bf_rx_fb_nr_cnt; 1466 1467 /* Tx Beamformee Rx NDPA & Tx feedback report */ 1468 data[ei++] = mib->tx_bf_fb_cpl_cnt; 1469 data[ei++] = mib->tx_bf_fb_trig_cnt; 1470 1471 /* Tx SU & MU counters */ 1472 data[ei++] = mib->tx_bf_cnt; 1473 data[ei++] = mib->tx_mu_mpdu_cnt; 1474 data[ei++] = mib->tx_mu_acked_mpdu_cnt; 1475 data[ei++] = mib->tx_su_acked_mpdu_cnt; 1476 1477 /* Tx amsdu info (pack-count histogram) */ 1478 for (i = 0; i < ARRAY_SIZE(mib->tx_amsdu); i++) 1479 data[ei++] = mib->tx_amsdu[i]; 1480 1481 /* rx counters */ 1482 data[ei++] = mib->rx_fifo_full_cnt; 1483 data[ei++] = mib->rx_mpdu_cnt; 1484 data[ei++] = mib->channel_idle_cnt; 1485 data[ei++] = mib->primary_cca_busy_time; 1486 data[ei++] = mib->secondary_cca_busy_time; 1487 data[ei++] = mib->primary_energy_detect_time; 1488 data[ei++] = mib->cck_mdrdy_time; 1489 data[ei++] = mib->ofdm_mdrdy_time; 1490 data[ei++] = mib->green_mdrdy_time; 1491 data[ei++] = mib->rx_vector_mismatch_cnt; 1492 data[ei++] = mib->rx_delimiter_fail_cnt; 1493 data[ei++] = mib->rx_mrdy_cnt; 1494 data[ei++] = mib->rx_len_mismatch_cnt; 1495 data[ei++] = mib->rx_ampdu_cnt; 1496 data[ei++] = mib->rx_ampdu_bytes_cnt; 1497 data[ei++] = mib->rx_ampdu_valid_subframe_cnt; 1498 data[ei++] = mib->rx_ampdu_valid_subframe_bytes_cnt; 1499 data[ei++] = mib->rx_pfdrop_cnt; 1500 data[ei++] = mib->rx_vec_queue_overflow_drop_cnt; 1501 data[ei++] = mib->rx_ba_cnt; 1502 1503 data[ei++] = mib->dl_cck_cnt; 1504 data[ei++] = mib->dl_ofdm_cnt; 1505 data[ei++] = mib->dl_htmix_cnt; 1506 data[ei++] = mib->dl_htgf_cnt; 1507 data[ei++] = mib->dl_vht_su_cnt; 1508 data[ei++] = mib->dl_vht_2mu_cnt; 1509 data[ei++] = mib->dl_vht_3mu_cnt; 1510 data[ei++] = mib->dl_vht_4mu_cnt; 1511 data[ei++] = mib->dl_he_su_cnt; 1512 data[ei++] = mib->dl_he_ext_su_cnt; 1513 data[ei++] = mib->dl_he_2ru_cnt; 1514 data[ei++] = mib->dl_he_2mu_cnt; 1515 data[ei++] = mib->dl_he_3ru_cnt; 1516 data[ei++] = mib->dl_he_3mu_cnt; 1517 data[ei++] = mib->dl_he_4ru_cnt; 1518 data[ei++] = mib->dl_he_4mu_cnt; 1519 data[ei++] = mib->dl_he_5to8ru_cnt; 1520 data[ei++] = mib->dl_he_9to16ru_cnt; 1521 data[ei++] = mib->dl_he_gtr16ru_cnt; 1522 1523 data[ei++] = mib->ul_hetrig_su_cnt; 1524 data[ei++] = mib->ul_hetrig_2ru_cnt; 1525 data[ei++] = mib->ul_hetrig_3ru_cnt; 1526 data[ei++] = mib->ul_hetrig_4ru_cnt; 1527 data[ei++] = mib->ul_hetrig_5to8ru_cnt; 1528 data[ei++] = mib->ul_hetrig_9to16ru_cnt; 1529 data[ei++] = mib->ul_hetrig_gtr16ru_cnt; 1530 data[ei++] = mib->ul_hetrig_2mu_cnt; 1531 data[ei++] = mib->ul_hetrig_3mu_cnt; 1532 data[ei++] = mib->ul_hetrig_4mu_cnt; 1533 1534 /* Add values for all stations owned by this vif */ 1535 wi.initial_stat_idx = ei; 1536 ieee80211_iterate_stations_atomic(hw, mt7915_ethtool_worker, &wi); 1537 1538 mutex_unlock(&dev->mt76.mutex); 1539 1540 if (wi.sta_count == 0) 1541 return; 1542 1543 ei += wi.worker_stat_count; 1544 1545 mt76_ethtool_page_pool_stats(&dev->mt76, &data[ei], &ei); 1546 1547 stats_size = MT7915_SSTATS_LEN + page_pool_ethtool_stats_get_count(); 1548 if (ei != stats_size) 1549 dev_err(dev->mt76.dev, "ei: %d size: %d", ei, stats_size); 1550} 1551 1552static void 1553mt7915_twt_teardown_request(struct ieee80211_hw *hw, 1554 struct ieee80211_sta *sta, 1555 u8 flowid) 1556{ 1557 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 1558 struct mt7915_dev *dev = mt7915_hw_dev(hw); 1559 1560 mutex_lock(&dev->mt76.mutex); 1561 mt7915_mac_twt_teardown_flow(dev, msta, flowid); 1562 mutex_unlock(&dev->mt76.mutex); 1563} 1564 1565static int 1566mt7915_set_radar_background(struct ieee80211_hw *hw, 1567 struct cfg80211_chan_def *chandef) 1568{ 1569 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1570 struct mt7915_dev *dev = phy->dev; 1571 int ret = -EINVAL; 1572 bool running; 1573 1574 mutex_lock(&dev->mt76.mutex); 1575 1576 if (dev->mt76.region == NL80211_DFS_UNSET) 1577 goto out; 1578 1579 if (dev->rdd2_phy && dev->rdd2_phy != phy) { 1580 /* rdd2 is already locked */ 1581 ret = -EBUSY; 1582 goto out; 1583 } 1584 1585 /* rdd2 already configured on a radar channel */ 1586 running = dev->rdd2_phy && 1587 cfg80211_chandef_valid(&dev->rdd2_chandef) && 1588 !!(dev->rdd2_chandef.chan->flags & IEEE80211_CHAN_RADAR); 1589 1590 if (!chandef || running || 1591 !(chandef->chan->flags & IEEE80211_CHAN_RADAR)) { 1592 ret = mt7915_mcu_rdd_background_enable(phy, NULL); 1593 if (ret) 1594 goto out; 1595 1596 if (!running) 1597 goto update_phy; 1598 } 1599 1600 ret = mt7915_mcu_rdd_background_enable(phy, chandef); 1601 if (ret) 1602 goto out; 1603 1604update_phy: 1605 dev->rdd2_phy = chandef ? phy : NULL; 1606 if (chandef) 1607 dev->rdd2_chandef = *chandef; 1608out: 1609 mutex_unlock(&dev->mt76.mutex); 1610 1611 return ret; 1612} 1613 1614#ifdef CONFIG_NET_MEDIATEK_SOC_WED 1615static int 1616mt7915_net_fill_forward_path(struct ieee80211_hw *hw, 1617 struct ieee80211_vif *vif, 1618 struct ieee80211_sta *sta, 1619 struct net_device_path_ctx *ctx, 1620 struct net_device_path *path) 1621{ 1622 struct mt7915_vif *mvif = (struct mt7915_vif *)vif->drv_priv; 1623 struct mt7915_sta *msta = (struct mt7915_sta *)sta->drv_priv; 1624 struct mt7915_dev *dev = mt7915_hw_dev(hw); 1625 struct mt7915_phy *phy = mt7915_hw_phy(hw); 1626 struct mtk_wed_device *wed = &dev->mt76.mmio.wed; 1627 1628 if (!mtk_wed_device_active(wed)) 1629 return -ENODEV; 1630 1631 if (msta->wcid.idx > 0xff) 1632 return -EIO; 1633 1634 path->type = DEV_PATH_MTK_WDMA; 1635 path->dev = ctx->dev; 1636 path->mtk_wdma.wdma_idx = wed->wdma_idx; 1637 path->mtk_wdma.bss = mvif->mt76.idx; 1638 path->mtk_wdma.wcid = is_mt7915(&dev->mt76) ? msta->wcid.idx : 0x3ff; 1639 path->mtk_wdma.queue = phy != &dev->phy; 1640 1641 ctx->dev = NULL; 1642 1643 return 0; 1644} 1645#endif 1646 1647const struct ieee80211_ops mt7915_ops = { 1648 .tx = mt7915_tx, 1649 .start = mt7915_start, 1650 .stop = mt7915_stop, 1651 .add_interface = mt7915_add_interface, 1652 .remove_interface = mt7915_remove_interface, 1653 .config = mt7915_config, 1654 .conf_tx = mt7915_conf_tx, 1655 .configure_filter = mt7915_configure_filter, 1656 .bss_info_changed = mt7915_bss_info_changed, 1657 .start_ap = mt7915_start_ap, 1658 .stop_ap = mt7915_stop_ap, 1659 .sta_add = mt7915_sta_add, 1660 .sta_remove = mt7915_sta_remove, 1661 .sta_pre_rcu_remove = mt76_sta_pre_rcu_remove, 1662 .sta_rc_update = mt7915_sta_rc_update, 1663 .set_key = mt7915_set_key, 1664 .ampdu_action = mt7915_ampdu_action, 1665 .set_rts_threshold = mt7915_set_rts_threshold, 1666 .wake_tx_queue = mt76_wake_tx_queue, 1667 .sw_scan_start = mt76_sw_scan, 1668 .sw_scan_complete = mt76_sw_scan_complete, 1669 .release_buffered_frames = mt76_release_buffered_frames, 1670 .get_txpower = mt76_get_txpower, 1671 .set_sar_specs = mt7915_set_sar_specs, 1672 .channel_switch_beacon = mt7915_channel_switch_beacon, 1673 .get_stats = mt7915_get_stats, 1674 .get_et_sset_count = mt7915_get_et_sset_count, 1675 .get_et_stats = mt7915_get_et_stats, 1676 .get_et_strings = mt7915_get_et_strings, 1677 .get_tsf = mt7915_get_tsf, 1678 .set_tsf = mt7915_set_tsf, 1679 .offset_tsf = mt7915_offset_tsf, 1680 .get_survey = mt76_get_survey, 1681 .get_antenna = mt76_get_antenna, 1682 .set_antenna = mt7915_set_antenna, 1683 .set_bitrate_mask = mt7915_set_bitrate_mask, 1684 .set_coverage_class = mt7915_set_coverage_class, 1685 .sta_statistics = mt7915_sta_statistics, 1686 .sta_set_txpwr = mt7915_sta_set_txpwr, 1687 .sta_set_4addr = mt7915_sta_set_4addr, 1688 .sta_set_decap_offload = mt7915_sta_set_decap_offload, 1689 .add_twt_setup = mt7915_mac_add_twt_setup, 1690 .twt_teardown_request = mt7915_twt_teardown_request, 1691 CFG80211_TESTMODE_CMD(mt76_testmode_cmd) 1692 CFG80211_TESTMODE_DUMP(mt76_testmode_dump) 1693#ifdef CONFIG_MAC80211_DEBUGFS 1694 .sta_add_debugfs = mt7915_sta_add_debugfs, 1695#endif 1696 .set_radar_background = mt7915_set_radar_background, 1697#ifdef CONFIG_NET_MEDIATEK_SOC_WED 1698 .net_fill_forward_path = mt7915_net_fill_forward_path, 1699#endif 1700}; 1701