1 // SPDX-License-Identifier: ISC 2 /* Copyright (C) 2020 MediaTek Inc. */ 3 4 #include <linux/etherdevice.h> 5 #include "mt7915.h" 6 #include "mac.h" 7 #include "eeprom.h" 8 9 static void 10 mt7915_mac_init_band(struct mt7915_dev *dev, u8 band) 11 { 12 u32 mask, set; 13 14 mt76_rmw_field(dev, MT_TMAC_CTCR0(band), 15 MT_TMAC_CTCR0_INS_DDLMT_REFTIME, 0x3f); 16 mt76_set(dev, MT_TMAC_CTCR0(band), 17 MT_TMAC_CTCR0_INS_DDLMT_VHT_SMPDU_EN | 18 MT_TMAC_CTCR0_INS_DDLMT_EN); 19 20 mask = MT_MDP_RCFR0_MCU_RX_MGMT | 21 MT_MDP_RCFR0_MCU_RX_CTL_NON_BAR | 22 MT_MDP_RCFR0_MCU_RX_CTL_BAR; 23 set = FIELD_PREP(MT_MDP_RCFR0_MCU_RX_MGMT, MT_MDP_TO_HIF) | 24 FIELD_PREP(MT_MDP_RCFR0_MCU_RX_CTL_NON_BAR, MT_MDP_TO_HIF) | 25 FIELD_PREP(MT_MDP_RCFR0_MCU_RX_CTL_BAR, MT_MDP_TO_HIF); 26 mt76_rmw(dev, MT_MDP_BNRCFR0(band), mask, set); 27 28 mask = MT_MDP_RCFR1_MCU_RX_BYPASS | 29 MT_MDP_RCFR1_RX_DROPPED_UCAST | 30 MT_MDP_RCFR1_RX_DROPPED_MCAST; 31 set = FIELD_PREP(MT_MDP_RCFR1_MCU_RX_BYPASS, MT_MDP_TO_HIF) | 32 FIELD_PREP(MT_MDP_RCFR1_RX_DROPPED_UCAST, MT_MDP_TO_HIF) | 33 FIELD_PREP(MT_MDP_RCFR1_RX_DROPPED_MCAST, MT_MDP_TO_HIF); 34 mt76_rmw(dev, MT_MDP_BNRCFR1(band), mask, set); 35 36 mt76_set(dev, MT_WF_RMAC_MIB_TIME0(band), MT_WF_RMAC_MIB_RXTIME_EN); 37 mt76_set(dev, MT_WF_RMAC_MIB_AIRTIME0(band), MT_WF_RMAC_MIB_RXTIME_EN); 38 } 39 40 static void mt7915_mac_init(struct mt7915_dev *dev) 41 { 42 int i; 43 44 mt76_rmw_field(dev, MT_DMA_DCR0, MT_DMA_DCR0_MAX_RX_LEN, 1536); 45 mt76_rmw_field(dev, MT_MDP_DCR1, MT_MDP_DCR1_MAX_RX_LEN, 1536); 46 /* enable rx rate report */ 47 mt76_set(dev, MT_DMA_DCR0, MT_DMA_DCR0_RXD_G5_EN); 48 /* disable hardware de-agg */ 49 mt76_clear(dev, MT_MDP_DCR0, MT_MDP_DCR0_DAMSDU_EN); 50 51 for (i = 0; i < MT7915_WTBL_SIZE; i++) 52 mt7915_mac_wtbl_update(dev, i, 53 MT_WTBL_UPDATE_ADM_COUNT_CLEAR); 54 55 mt7915_mac_init_band(dev, 0); 56 mt7915_mac_init_band(dev, 1); 57 mt7915_mcu_set_rts_thresh(&dev->phy, 0x92b); 58 } 59 60 static int mt7915_txbf_init(struct mt7915_dev *dev) 61 { 62 int ret; 63 64 /* 65 * TODO: DBDC & check whether iBF phase calibration data has 66 * been stored in eeprom offset 0x651~0x7b8, then write down 67 * 0x1111 into 0x651 and 0x651 to trigger iBF. 68 */ 69 70 /* trigger sounding packets */ 71 ret = mt7915_mcu_set_txbf_sounding(dev); 72 if (ret) 73 return ret; 74 75 /* enable iBF & eBF */ 76 return mt7915_mcu_set_txbf_type(dev); 77 } 78 79 static void 80 mt7915_init_txpower_band(struct mt7915_dev *dev, 81 struct ieee80211_supported_band *sband) 82 { 83 int i, n_chains = hweight8(dev->mphy.antenna_mask); 84 85 for (i = 0; i < sband->n_channels; i++) { 86 struct ieee80211_channel *chan = &sband->channels[i]; 87 u32 target_power = 0; 88 int j; 89 90 for (j = 0; j < n_chains; j++) { 91 u32 val; 92 93 val = mt7915_eeprom_get_target_power(dev, chan, j); 94 target_power = max(target_power, val); 95 } 96 97 chan->max_power = min_t(int, chan->max_reg_power, 98 target_power / 2); 99 chan->orig_mpwr = target_power / 2; 100 } 101 } 102 103 static void mt7915_init_txpower(struct mt7915_dev *dev) 104 { 105 mt7915_init_txpower_band(dev, &dev->mphy.sband_2g.sband); 106 mt7915_init_txpower_band(dev, &dev->mphy.sband_5g.sband); 107 108 mt7915_eeprom_init_sku(dev); 109 } 110 111 static void mt7915_init_work(struct work_struct *work) 112 { 113 struct mt7915_dev *dev = container_of(work, struct mt7915_dev, 114 init_work); 115 116 mt7915_mcu_set_eeprom(dev); 117 mt7915_mac_init(dev); 118 mt7915_init_txpower(dev); 119 mt7915_txbf_init(dev); 120 } 121 122 static int mt7915_init_hardware(struct mt7915_dev *dev) 123 { 124 int ret, idx; 125 126 mt76_wr(dev, MT_INT_SOURCE_CSR, ~0); 127 128 INIT_WORK(&dev->init_work, mt7915_init_work); 129 spin_lock_init(&dev->token_lock); 130 idr_init(&dev->token); 131 132 ret = mt7915_dma_init(dev); 133 if (ret) 134 return ret; 135 136 set_bit(MT76_STATE_INITIALIZED, &dev->mphy.state); 137 138 /* 139 * force firmware operation mode into normal state, 140 * which should be set before firmware download stage. 141 */ 142 mt76_wr(dev, MT_SWDEF_MODE, MT_SWDEF_NORMAL_MODE); 143 144 ret = mt7915_mcu_init(dev); 145 if (ret) 146 return ret; 147 148 ret = mt7915_eeprom_init(dev); 149 if (ret < 0) 150 return ret; 151 152 /* Beacon and mgmt frames should occupy wcid 0 */ 153 idx = mt76_wcid_alloc(dev->mt76.wcid_mask, MT7915_WTBL_STA - 1); 154 if (idx) 155 return -ENOSPC; 156 157 dev->mt76.global_wcid.idx = idx; 158 dev->mt76.global_wcid.hw_key_idx = -1; 159 dev->mt76.global_wcid.tx_info |= MT_WCID_TX_INFO_SET; 160 rcu_assign_pointer(dev->mt76.wcid[idx], &dev->mt76.global_wcid); 161 162 return 0; 163 } 164 165 #define CCK_RATE(_idx, _rate) { \ 166 .bitrate = _rate, \ 167 .flags = IEEE80211_RATE_SHORT_PREAMBLE, \ 168 .hw_value = (MT_PHY_TYPE_CCK << 8) | (_idx), \ 169 .hw_value_short = (MT_PHY_TYPE_CCK << 8) | (4 + (_idx)), \ 170 } 171 172 #define OFDM_RATE(_idx, _rate) { \ 173 .bitrate = _rate, \ 174 .hw_value = (MT_PHY_TYPE_OFDM << 8) | (_idx), \ 175 .hw_value_short = (MT_PHY_TYPE_OFDM << 8) | (_idx), \ 176 } 177 178 static struct ieee80211_rate mt7915_rates[] = { 179 CCK_RATE(0, 10), 180 CCK_RATE(1, 20), 181 CCK_RATE(2, 55), 182 CCK_RATE(3, 110), 183 OFDM_RATE(11, 60), 184 OFDM_RATE(15, 90), 185 OFDM_RATE(10, 120), 186 OFDM_RATE(14, 180), 187 OFDM_RATE(9, 240), 188 OFDM_RATE(13, 360), 189 OFDM_RATE(8, 480), 190 OFDM_RATE(12, 540), 191 }; 192 193 static const struct ieee80211_iface_limit if_limits[] = { 194 { 195 .max = 1, 196 .types = BIT(NL80211_IFTYPE_ADHOC) 197 }, { 198 .max = MT7915_MAX_INTERFACES, 199 .types = BIT(NL80211_IFTYPE_AP) | 200 #ifdef CONFIG_MAC80211_MESH 201 BIT(NL80211_IFTYPE_MESH_POINT) | 202 #endif 203 BIT(NL80211_IFTYPE_STATION) 204 } 205 }; 206 207 static const struct ieee80211_iface_combination if_comb[] = { 208 { 209 .limits = if_limits, 210 .n_limits = ARRAY_SIZE(if_limits), 211 .max_interfaces = 4, 212 .num_different_channels = 1, 213 .beacon_int_infra_match = true, 214 .radar_detect_widths = BIT(NL80211_CHAN_WIDTH_20_NOHT) | 215 BIT(NL80211_CHAN_WIDTH_20) | 216 BIT(NL80211_CHAN_WIDTH_40) | 217 BIT(NL80211_CHAN_WIDTH_80) | 218 BIT(NL80211_CHAN_WIDTH_160) | 219 BIT(NL80211_CHAN_WIDTH_80P80), 220 } 221 }; 222 223 static void 224 mt7915_regd_notifier(struct wiphy *wiphy, 225 struct regulatory_request *request) 226 { 227 struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy); 228 struct mt7915_dev *dev = mt7915_hw_dev(hw); 229 struct mt76_phy *mphy = hw->priv; 230 struct mt7915_phy *phy = mphy->priv; 231 struct cfg80211_chan_def *chandef = &mphy->chandef; 232 233 dev->mt76.region = request->dfs_region; 234 235 if (!(chandef->chan->flags & IEEE80211_CHAN_RADAR)) 236 return; 237 238 mt7915_dfs_init_radar_detector(phy); 239 } 240 241 static void 242 mt7915_init_wiphy(struct ieee80211_hw *hw) 243 { 244 struct mt7915_phy *phy = mt7915_hw_phy(hw); 245 struct wiphy *wiphy = hw->wiphy; 246 247 hw->queues = 4; 248 hw->max_rx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF; 249 hw->max_tx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF; 250 251 phy->slottime = 9; 252 253 hw->sta_data_size = sizeof(struct mt7915_sta); 254 hw->vif_data_size = sizeof(struct mt7915_vif); 255 256 wiphy->iface_combinations = if_comb; 257 wiphy->n_iface_combinations = ARRAY_SIZE(if_comb); 258 wiphy->reg_notifier = mt7915_regd_notifier; 259 wiphy->flags |= WIPHY_FLAG_HAS_CHANNEL_SWITCH; 260 261 wiphy_ext_feature_set(wiphy, NL80211_EXT_FEATURE_VHT_IBSS); 262 263 ieee80211_hw_set(hw, HAS_RATE_CONTROL); 264 265 hw->max_tx_fragments = 4; 266 } 267 268 void mt7915_set_stream_vht_txbf_caps(struct mt7915_phy *phy) 269 { 270 int nss = hweight8(phy->chainmask); 271 u32 *cap = &phy->mt76->sband_5g.sband.vht_cap.cap; 272 273 *cap |= IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE | 274 IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE | 275 (3 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT); 276 277 *cap &= ~(IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK | 278 IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE | 279 IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE); 280 281 if (nss < 2) 282 return; 283 284 *cap |= IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE | 285 IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE | 286 FIELD_PREP(IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK, 287 nss - 1); 288 } 289 290 static void 291 mt7915_set_stream_he_txbf_caps(struct ieee80211_sta_he_cap *he_cap, 292 int vif, int nss) 293 { 294 struct ieee80211_he_cap_elem *elem = &he_cap->he_cap_elem; 295 struct ieee80211_he_mcs_nss_supp *mcs = &he_cap->he_mcs_nss_supp; 296 u8 c; 297 298 #ifdef CONFIG_MAC80211_MESH 299 if (vif == NL80211_IFTYPE_MESH_POINT) 300 return; 301 #endif 302 303 elem->phy_cap_info[3] &= ~IEEE80211_HE_PHY_CAP3_SU_BEAMFORMER; 304 elem->phy_cap_info[4] &= ~IEEE80211_HE_PHY_CAP4_MU_BEAMFORMER; 305 306 c = IEEE80211_HE_PHY_CAP5_BEAMFORMEE_NUM_SND_DIM_UNDER_80MHZ_MASK | 307 IEEE80211_HE_PHY_CAP5_BEAMFORMEE_NUM_SND_DIM_ABOVE_80MHZ_MASK; 308 elem->phy_cap_info[5] &= ~c; 309 310 c = IEEE80211_HE_PHY_CAP6_TRIG_SU_BEAMFORMER_FB | 311 IEEE80211_HE_PHY_CAP6_TRIG_MU_BEAMFORMER_FB; 312 elem->phy_cap_info[6] &= ~c; 313 314 elem->phy_cap_info[7] &= ~IEEE80211_HE_PHY_CAP7_MAX_NC_MASK; 315 316 c = IEEE80211_HE_PHY_CAP2_NDP_4x_LTF_AND_3_2US | 317 IEEE80211_HE_PHY_CAP2_UL_MU_FULL_MU_MIMO | 318 IEEE80211_HE_PHY_CAP2_UL_MU_PARTIAL_MU_MIMO; 319 elem->phy_cap_info[2] |= c; 320 321 c = IEEE80211_HE_PHY_CAP4_SU_BEAMFORMEE | 322 IEEE80211_HE_PHY_CAP4_BEAMFORMEE_MAX_STS_UNDER_80MHZ_4 | 323 IEEE80211_HE_PHY_CAP4_BEAMFORMEE_MAX_STS_ABOVE_80MHZ_4; 324 elem->phy_cap_info[4] |= c; 325 326 /* do not support NG16 due to spec D4.0 changes subcarrier idx */ 327 c = IEEE80211_HE_PHY_CAP6_CODEBOOK_SIZE_42_SU | 328 IEEE80211_HE_PHY_CAP6_CODEBOOK_SIZE_75_MU; 329 330 if (vif == NL80211_IFTYPE_STATION) 331 c |= IEEE80211_HE_PHY_CAP6_PARTIAL_BANDWIDTH_DL_MUMIMO; 332 333 elem->phy_cap_info[6] |= c; 334 335 if (nss < 2) 336 return; 337 338 if (vif != NL80211_IFTYPE_AP) 339 return; 340 341 elem->phy_cap_info[3] |= IEEE80211_HE_PHY_CAP3_SU_BEAMFORMER; 342 elem->phy_cap_info[4] |= IEEE80211_HE_PHY_CAP4_MU_BEAMFORMER; 343 344 /* num_snd_dim */ 345 c = (nss - 1) | (max_t(int, mcs->tx_mcs_160, 1) << 3); 346 elem->phy_cap_info[5] |= c; 347 348 c = IEEE80211_HE_PHY_CAP6_TRIG_SU_BEAMFORMER_FB | 349 IEEE80211_HE_PHY_CAP6_TRIG_MU_BEAMFORMER_FB; 350 elem->phy_cap_info[6] |= c; 351 352 /* the maximum cap is 4 x 3, (Nr, Nc) = (3, 2) */ 353 elem->phy_cap_info[7] |= min_t(int, nss - 1, 2) << 3; 354 } 355 356 static void 357 mt7915_gen_ppe_thresh(u8 *he_ppet) 358 { 359 int ru, nss, max_nss = 1, max_ru = 3; 360 u8 bit = 7, ru_bit_mask = 0x7; 361 u8 ppet16_ppet8_ru3_ru0[] = {0x1c, 0xc7, 0x71}; 362 363 he_ppet[0] = max_nss & IEEE80211_PPE_THRES_NSS_MASK; 364 he_ppet[0] |= (ru_bit_mask << 365 IEEE80211_PPE_THRES_RU_INDEX_BITMASK_POS) & 366 IEEE80211_PPE_THRES_RU_INDEX_BITMASK_MASK; 367 368 for (nss = 0; nss <= max_nss; nss++) { 369 for (ru = 0; ru < max_ru; ru++) { 370 u8 val; 371 int i; 372 373 if (!(ru_bit_mask & BIT(ru))) 374 continue; 375 376 val = (ppet16_ppet8_ru3_ru0[nss] >> (ru * 6)) & 377 0x3f; 378 val = ((val >> 3) & 0x7) | ((val & 0x7) << 3); 379 for (i = 5; i >= 0; i--) { 380 he_ppet[bit / 8] |= 381 ((val >> i) & 0x1) << ((bit % 8)); 382 bit++; 383 } 384 } 385 } 386 } 387 388 static int 389 mt7915_init_he_caps(struct mt7915_phy *phy, enum nl80211_band band, 390 struct ieee80211_sband_iftype_data *data) 391 { 392 int i, idx = 0; 393 int nss = hweight8(phy->chainmask); 394 u16 mcs_map = 0; 395 396 for (i = 0; i < 8; i++) { 397 if (i < nss) 398 mcs_map |= (IEEE80211_HE_MCS_SUPPORT_0_11 << (i * 2)); 399 else 400 mcs_map |= (IEEE80211_HE_MCS_NOT_SUPPORTED << (i * 2)); 401 } 402 403 for (i = 0; i < NUM_NL80211_IFTYPES; i++) { 404 struct ieee80211_sta_he_cap *he_cap = &data[idx].he_cap; 405 struct ieee80211_he_cap_elem *he_cap_elem = 406 &he_cap->he_cap_elem; 407 struct ieee80211_he_mcs_nss_supp *he_mcs = 408 &he_cap->he_mcs_nss_supp; 409 410 switch (i) { 411 case NL80211_IFTYPE_STATION: 412 case NL80211_IFTYPE_AP: 413 #ifdef CONFIG_MAC80211_MESH 414 case NL80211_IFTYPE_MESH_POINT: 415 #endif 416 break; 417 default: 418 continue; 419 } 420 421 data[idx].types_mask = BIT(i); 422 he_cap->has_he = true; 423 424 he_cap_elem->mac_cap_info[0] = 425 IEEE80211_HE_MAC_CAP0_HTC_HE; 426 he_cap_elem->mac_cap_info[3] = 427 IEEE80211_HE_MAC_CAP3_OMI_CONTROL | 428 IEEE80211_HE_MAC_CAP3_MAX_AMPDU_LEN_EXP_RESERVED; 429 he_cap_elem->mac_cap_info[4] = 430 IEEE80211_HE_MAC_CAP4_AMDSU_IN_AMPDU; 431 432 if (band == NL80211_BAND_2GHZ) 433 he_cap_elem->phy_cap_info[0] = 434 IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_IN_2G; 435 else if (band == NL80211_BAND_5GHZ) 436 he_cap_elem->phy_cap_info[0] = 437 IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_80MHZ_IN_5G | 438 IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_160MHZ_IN_5G | 439 IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_80PLUS80_MHZ_IN_5G; 440 441 he_cap_elem->phy_cap_info[1] = 442 IEEE80211_HE_PHY_CAP1_LDPC_CODING_IN_PAYLOAD; 443 he_cap_elem->phy_cap_info[2] = 444 IEEE80211_HE_PHY_CAP2_STBC_TX_UNDER_80MHZ | 445 IEEE80211_HE_PHY_CAP2_STBC_RX_UNDER_80MHZ; 446 447 switch (i) { 448 case NL80211_IFTYPE_AP: 449 he_cap_elem->mac_cap_info[0] |= 450 IEEE80211_HE_MAC_CAP0_TWT_RES; 451 he_cap_elem->mac_cap_info[2] |= 452 IEEE80211_HE_MAC_CAP2_BSR; 453 he_cap_elem->mac_cap_info[4] |= 454 IEEE80211_HE_MAC_CAP4_BQR; 455 he_cap_elem->mac_cap_info[5] |= 456 IEEE80211_HE_MAC_CAP5_OM_CTRL_UL_MU_DATA_DIS_RX; 457 he_cap_elem->phy_cap_info[3] |= 458 IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_QPSK | 459 IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_QPSK; 460 he_cap_elem->phy_cap_info[6] |= 461 IEEE80211_HE_PHY_CAP6_PPE_THRESHOLD_PRESENT; 462 break; 463 case NL80211_IFTYPE_STATION: 464 he_cap_elem->mac_cap_info[0] |= 465 IEEE80211_HE_MAC_CAP0_TWT_REQ; 466 he_cap_elem->mac_cap_info[1] |= 467 IEEE80211_HE_MAC_CAP1_TF_MAC_PAD_DUR_16US; 468 469 if (band == NL80211_BAND_2GHZ) 470 he_cap_elem->phy_cap_info[0] |= 471 IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_RU_MAPPING_IN_2G; 472 else if (band == NL80211_BAND_5GHZ) 473 he_cap_elem->phy_cap_info[0] |= 474 IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_RU_MAPPING_IN_5G; 475 476 he_cap_elem->phy_cap_info[1] |= 477 IEEE80211_HE_PHY_CAP1_DEVICE_CLASS_A | 478 IEEE80211_HE_PHY_CAP1_HE_LTF_AND_GI_FOR_HE_PPDUS_0_8US; 479 he_cap_elem->phy_cap_info[3] |= 480 IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_TX_QPSK | 481 IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_QPSK; 482 he_cap_elem->phy_cap_info[6] |= 483 IEEE80211_HE_PHY_CAP6_TRIG_CQI_FB | 484 IEEE80211_HE_PHY_CAP6_PARTIAL_BW_EXT_RANGE | 485 IEEE80211_HE_PHY_CAP6_PPE_THRESHOLD_PRESENT; 486 he_cap_elem->phy_cap_info[7] |= 487 IEEE80211_HE_PHY_CAP7_POWER_BOOST_FACTOR_AR | 488 IEEE80211_HE_PHY_CAP7_HE_SU_MU_PPDU_4XLTF_AND_08_US_GI; 489 he_cap_elem->phy_cap_info[8] |= 490 IEEE80211_HE_PHY_CAP8_20MHZ_IN_40MHZ_HE_PPDU_IN_2G | 491 IEEE80211_HE_PHY_CAP8_20MHZ_IN_160MHZ_HE_PPDU | 492 IEEE80211_HE_PHY_CAP8_80MHZ_IN_160MHZ_HE_PPDU | 493 IEEE80211_HE_PHY_CAP8_DCM_MAX_RU_484; 494 he_cap_elem->phy_cap_info[9] |= 495 IEEE80211_HE_PHY_CAP9_LONGER_THAN_16_SIGB_OFDM_SYM | 496 IEEE80211_HE_PHY_CAP9_NON_TRIGGERED_CQI_FEEDBACK | 497 IEEE80211_HE_PHY_CAP9_TX_1024_QAM_LESS_THAN_242_TONE_RU | 498 IEEE80211_HE_PHY_CAP9_RX_1024_QAM_LESS_THAN_242_TONE_RU | 499 IEEE80211_HE_PHY_CAP9_RX_FULL_BW_SU_USING_MU_WITH_COMP_SIGB | 500 IEEE80211_HE_PHY_CAP9_RX_FULL_BW_SU_USING_MU_WITH_NON_COMP_SIGB; 501 break; 502 } 503 504 he_mcs->rx_mcs_80 = cpu_to_le16(mcs_map); 505 he_mcs->tx_mcs_80 = cpu_to_le16(mcs_map); 506 he_mcs->rx_mcs_160 = cpu_to_le16(mcs_map); 507 he_mcs->tx_mcs_160 = cpu_to_le16(mcs_map); 508 he_mcs->rx_mcs_80p80 = cpu_to_le16(mcs_map); 509 he_mcs->tx_mcs_80p80 = cpu_to_le16(mcs_map); 510 511 mt7915_set_stream_he_txbf_caps(he_cap, i, nss); 512 513 memset(he_cap->ppe_thres, 0, sizeof(he_cap->ppe_thres)); 514 if (he_cap_elem->phy_cap_info[6] & 515 IEEE80211_HE_PHY_CAP6_PPE_THRESHOLD_PRESENT) { 516 mt7915_gen_ppe_thresh(he_cap->ppe_thres); 517 } else { 518 he_cap_elem->phy_cap_info[9] |= 519 IEEE80211_HE_PHY_CAP9_NOMIMAL_PKT_PADDING_16US; 520 } 521 idx++; 522 } 523 524 return idx; 525 } 526 527 void mt7915_set_stream_he_caps(struct mt7915_phy *phy) 528 { 529 struct ieee80211_sband_iftype_data *data; 530 struct ieee80211_supported_band *band; 531 struct mt76_dev *mdev = &phy->dev->mt76; 532 int n; 533 534 if (mdev->cap.has_2ghz) { 535 data = phy->iftype[NL80211_BAND_2GHZ]; 536 n = mt7915_init_he_caps(phy, NL80211_BAND_2GHZ, data); 537 538 band = &phy->mt76->sband_2g.sband; 539 band->iftype_data = data; 540 band->n_iftype_data = n; 541 } 542 543 if (mdev->cap.has_5ghz) { 544 data = phy->iftype[NL80211_BAND_5GHZ]; 545 n = mt7915_init_he_caps(phy, NL80211_BAND_5GHZ, data); 546 547 band = &phy->mt76->sband_5g.sband; 548 band->iftype_data = data; 549 band->n_iftype_data = n; 550 } 551 } 552 553 static void 554 mt7915_cap_dbdc_enable(struct mt7915_dev *dev) 555 { 556 dev->mphy.sband_5g.sband.vht_cap.cap &= 557 ~(IEEE80211_VHT_CAP_SHORT_GI_160 | 558 IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ); 559 560 if (dev->chainmask == 0xf) 561 dev->mphy.antenna_mask = dev->chainmask >> 2; 562 else 563 dev->mphy.antenna_mask = dev->chainmask >> 1; 564 565 dev->phy.chainmask = dev->mphy.antenna_mask; 566 dev->mphy.hw->wiphy->available_antennas_rx = dev->phy.chainmask; 567 dev->mphy.hw->wiphy->available_antennas_tx = dev->phy.chainmask; 568 569 mt76_set_stream_caps(&dev->mphy, true); 570 mt7915_set_stream_vht_txbf_caps(&dev->phy); 571 mt7915_set_stream_he_caps(&dev->phy); 572 } 573 574 static void 575 mt7915_cap_dbdc_disable(struct mt7915_dev *dev) 576 { 577 dev->mphy.sband_5g.sband.vht_cap.cap |= 578 IEEE80211_VHT_CAP_SHORT_GI_160 | 579 IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ; 580 581 dev->mphy.antenna_mask = dev->chainmask; 582 dev->phy.chainmask = dev->chainmask; 583 dev->mphy.hw->wiphy->available_antennas_rx = dev->chainmask; 584 dev->mphy.hw->wiphy->available_antennas_tx = dev->chainmask; 585 586 mt76_set_stream_caps(&dev->mphy, true); 587 mt7915_set_stream_vht_txbf_caps(&dev->phy); 588 mt7915_set_stream_he_caps(&dev->phy); 589 } 590 591 int mt7915_register_ext_phy(struct mt7915_dev *dev) 592 { 593 struct mt7915_phy *phy = mt7915_ext_phy(dev); 594 struct mt76_phy *mphy; 595 int ret; 596 bool bound; 597 598 /* TODO: enble DBDC */ 599 bound = mt7915_l1_rr(dev, MT_HW_BOUND) & BIT(5); 600 if (!bound) 601 return -EINVAL; 602 603 if (test_bit(MT76_STATE_RUNNING, &dev->mphy.state)) 604 return -EINVAL; 605 606 if (phy) 607 return 0; 608 609 mt7915_cap_dbdc_enable(dev); 610 mphy = mt76_alloc_phy(&dev->mt76, sizeof(*phy), &mt7915_ops); 611 if (!mphy) 612 return -ENOMEM; 613 614 phy = mphy->priv; 615 phy->dev = dev; 616 phy->mt76 = mphy; 617 phy->chainmask = dev->chainmask & ~dev->phy.chainmask; 618 mphy->antenna_mask = BIT(hweight8(phy->chainmask)) - 1; 619 mt7915_init_wiphy(mphy->hw); 620 621 INIT_LIST_HEAD(&phy->stats_list); 622 INIT_DELAYED_WORK(&phy->mac_work, mt7915_mac_work); 623 624 /* 625 * Make the secondary PHY MAC address local without overlapping with 626 * the usual MAC address allocation scheme on multiple virtual interfaces 627 */ 628 mphy->hw->wiphy->perm_addr[0] |= 2; 629 mphy->hw->wiphy->perm_addr[0] ^= BIT(7); 630 631 /* The second interface does not get any packets unless it has a vif */ 632 ieee80211_hw_set(mphy->hw, WANT_MONITOR_VIF); 633 634 ret = mt76_register_phy(mphy); 635 if (ret) 636 ieee80211_free_hw(mphy->hw); 637 638 return ret; 639 } 640 641 void mt7915_unregister_ext_phy(struct mt7915_dev *dev) 642 { 643 struct mt7915_phy *phy = mt7915_ext_phy(dev); 644 struct mt76_phy *mphy = dev->mt76.phy2; 645 646 if (!phy) 647 return; 648 649 mt7915_cap_dbdc_disable(dev); 650 mt76_unregister_phy(mphy); 651 ieee80211_free_hw(mphy->hw); 652 } 653 654 int mt7915_register_device(struct mt7915_dev *dev) 655 { 656 struct ieee80211_hw *hw = mt76_hw(dev); 657 int ret; 658 659 dev->phy.dev = dev; 660 dev->phy.mt76 = &dev->mt76.phy; 661 dev->mt76.phy.priv = &dev->phy; 662 INIT_LIST_HEAD(&dev->phy.stats_list); 663 INIT_WORK(&dev->rc_work, mt7915_mac_sta_rc_work); 664 INIT_DELAYED_WORK(&dev->phy.mac_work, mt7915_mac_work); 665 INIT_LIST_HEAD(&dev->sta_rc_list); 666 INIT_LIST_HEAD(&dev->sta_poll_list); 667 spin_lock_init(&dev->sta_poll_lock); 668 669 init_waitqueue_head(&dev->reset_wait); 670 INIT_WORK(&dev->reset_work, mt7915_mac_reset_work); 671 672 ret = mt7915_init_hardware(dev); 673 if (ret) 674 return ret; 675 676 mt7915_init_wiphy(hw); 677 dev->mphy.sband_2g.sband.ht_cap.cap |= 678 IEEE80211_HT_CAP_LDPC_CODING | 679 IEEE80211_HT_CAP_MAX_AMSDU; 680 dev->mphy.sband_5g.sband.ht_cap.cap |= 681 IEEE80211_HT_CAP_LDPC_CODING | 682 IEEE80211_HT_CAP_MAX_AMSDU; 683 dev->mphy.sband_5g.sband.vht_cap.cap |= 684 IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991 | 685 IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK; 686 mt7915_cap_dbdc_disable(dev); 687 dev->phy.dfs_state = -1; 688 689 ret = mt76_register_device(&dev->mt76, true, mt7915_rates, 690 ARRAY_SIZE(mt7915_rates)); 691 if (ret) 692 return ret; 693 694 ieee80211_queue_work(mt76_hw(dev), &dev->init_work); 695 696 return mt7915_init_debugfs(dev); 697 } 698 699 void mt7915_unregister_device(struct mt7915_dev *dev) 700 { 701 struct mt76_txwi_cache *txwi; 702 int id; 703 704 mt7915_unregister_ext_phy(dev); 705 mt76_unregister_device(&dev->mt76); 706 mt7915_mcu_exit(dev); 707 mt7915_dma_cleanup(dev); 708 709 spin_lock_bh(&dev->token_lock); 710 idr_for_each_entry(&dev->token, txwi, id) { 711 mt7915_txp_skb_unmap(&dev->mt76, txwi); 712 if (txwi->skb) { 713 struct ieee80211_hw *hw; 714 715 hw = mt76_tx_status_get_hw(&dev->mt76, txwi->skb); 716 ieee80211_free_txskb(hw, txwi->skb); 717 } 718 mt76_put_txwi(&dev->mt76, txwi); 719 } 720 spin_unlock_bh(&dev->token_lock); 721 idr_destroy(&dev->token); 722 723 mt76_free_device(&dev->mt76); 724 } 725