1 // SPDX-License-Identifier: ISC 2 /* Copyright (C) 2020 MediaTek Inc. */ 3 4 #include <linux/firmware.h> 5 #include <linux/moduleparam.h> 6 #include "mt7915.h" 7 #include "eeprom.h" 8 9 static bool enable_6ghz; 10 module_param(enable_6ghz, bool, 0644); 11 MODULE_PARM_DESC(enable_6ghz, "Enable 6 GHz instead of 5 GHz on hardware that supports both"); 12 13 static int mt7915_eeprom_load_precal(struct mt7915_dev *dev) 14 { 15 struct mt76_dev *mdev = &dev->mt76; 16 u8 *eeprom = mdev->eeprom.data; 17 u32 offs = is_mt7915(&dev->mt76) ? MT_EE_DO_PRE_CAL : MT_EE_DO_PRE_CAL_V2; 18 u32 size, val = eeprom[offs]; 19 int ret; 20 21 if (!dev->flash_mode || !val) 22 return 0; 23 24 size = mt7915_get_cal_group_size(dev) + mt7915_get_cal_dpd_size(dev); 25 26 dev->cal = devm_kzalloc(mdev->dev, size, GFP_KERNEL); 27 if (!dev->cal) 28 return -ENOMEM; 29 30 offs = is_mt7915(&dev->mt76) ? MT_EE_PRECAL : MT_EE_PRECAL_V2; 31 32 ret = mt76_get_of_data_from_mtd(mdev, dev->cal, offs, size); 33 if (!ret) 34 return ret; 35 36 ret = mt76_get_of_data_from_nvmem(mdev, dev->cal, "precal", size); 37 if (!ret) 38 return ret; 39 40 dev_warn(mdev->dev, "missing precal data, size=%d\n", size); 41 devm_kfree(mdev->dev, dev->cal); 42 dev->cal = NULL; 43 44 return ret; 45 } 46 47 static int mt7915_check_eeprom(struct mt7915_dev *dev) 48 { 49 u8 *eeprom = dev->mt76.eeprom.data; 50 u16 val = get_unaligned_le16(eeprom); 51 52 #define CHECK_EEPROM_ERR(match) (match ? 0 : -EINVAL) 53 switch (val) { 54 case 0x7915: 55 return CHECK_EEPROM_ERR(is_mt7915(&dev->mt76)); 56 case 0x7916: 57 return CHECK_EEPROM_ERR(is_mt7916(&dev->mt76)); 58 case 0x7981: 59 return CHECK_EEPROM_ERR(is_mt7981(&dev->mt76)); 60 case 0x7986: 61 return CHECK_EEPROM_ERR(is_mt7986(&dev->mt76)); 62 default: 63 return -EINVAL; 64 } 65 } 66 67 static char *mt7915_eeprom_name(struct mt7915_dev *dev) 68 { 69 switch (mt76_chip(&dev->mt76)) { 70 case 0x7915: 71 return dev->dbdc_support ? 72 MT7915_EEPROM_DEFAULT_DBDC : MT7915_EEPROM_DEFAULT; 73 case 0x7981: 74 /* mt7981 only supports mt7976 and only in DBDC mode */ 75 return MT7981_EEPROM_MT7976_DEFAULT_DBDC; 76 case 0x7986: 77 switch (mt7915_check_adie(dev, true)) { 78 case MT7976_ONE_ADIE_DBDC: 79 return MT7986_EEPROM_MT7976_DEFAULT_DBDC; 80 case MT7975_ONE_ADIE: 81 return MT7986_EEPROM_MT7975_DEFAULT; 82 case MT7976_ONE_ADIE: 83 return MT7986_EEPROM_MT7976_DEFAULT; 84 case MT7975_DUAL_ADIE: 85 return MT7986_EEPROM_MT7975_DUAL_DEFAULT; 86 case MT7976_DUAL_ADIE: 87 return MT7986_EEPROM_MT7976_DUAL_DEFAULT; 88 default: 89 break; 90 } 91 return NULL; 92 default: 93 return MT7916_EEPROM_DEFAULT; 94 } 95 } 96 97 static int 98 mt7915_eeprom_load_default(struct mt7915_dev *dev) 99 { 100 u8 *eeprom = dev->mt76.eeprom.data; 101 const struct firmware *fw = NULL; 102 int ret; 103 104 ret = request_firmware(&fw, mt7915_eeprom_name(dev), dev->mt76.dev); 105 if (ret) 106 return ret; 107 108 if (!fw || !fw->data) { 109 dev_err(dev->mt76.dev, "Invalid default bin\n"); 110 ret = -EINVAL; 111 goto out; 112 } 113 114 memcpy(eeprom, fw->data, mt7915_eeprom_size(dev)); 115 dev->flash_mode = true; 116 117 out: 118 release_firmware(fw); 119 120 return ret; 121 } 122 123 static int mt7915_eeprom_load(struct mt7915_dev *dev) 124 { 125 int ret; 126 u16 eeprom_size = mt7915_eeprom_size(dev); 127 128 ret = mt76_eeprom_init(&dev->mt76, eeprom_size); 129 if (ret < 0) 130 return ret; 131 132 if (ret) { 133 dev->flash_mode = true; 134 } else { 135 u8 free_block_num; 136 u32 block_num, i; 137 u32 eeprom_blk_size = MT7915_EEPROM_BLOCK_SIZE; 138 139 ret = mt7915_mcu_get_eeprom_free_block(dev, &free_block_num); 140 if (ret < 0) 141 return ret; 142 143 /* efuse info isn't enough */ 144 if (free_block_num >= 29) 145 return -EINVAL; 146 147 /* read eeprom data from efuse */ 148 block_num = DIV_ROUND_UP(eeprom_size, eeprom_blk_size); 149 for (i = 0; i < block_num; i++) { 150 ret = mt7915_mcu_get_eeprom(dev, i * eeprom_blk_size, NULL); 151 if (ret < 0) 152 return ret; 153 } 154 } 155 156 return mt7915_check_eeprom(dev); 157 } 158 159 static void mt7915_eeprom_parse_band_config(struct mt7915_phy *phy) 160 { 161 struct mt7915_dev *dev = phy->dev; 162 u8 *eeprom = dev->mt76.eeprom.data; 163 u8 band = phy->mt76->band_idx; 164 u32 val; 165 166 val = eeprom[MT_EE_WIFI_CONF + band]; 167 val = FIELD_GET(MT_EE_WIFI_CONF0_BAND_SEL, val); 168 169 if (!is_mt7915(&dev->mt76)) { 170 switch (val) { 171 case MT_EE_V2_BAND_SEL_5GHZ: 172 phy->mt76->cap.has_5ghz = true; 173 return; 174 case MT_EE_V2_BAND_SEL_6GHZ: 175 phy->mt76->cap.has_6ghz = true; 176 return; 177 case MT_EE_V2_BAND_SEL_5GHZ_6GHZ: 178 if (enable_6ghz) { 179 phy->mt76->cap.has_6ghz = true; 180 u8p_replace_bits(&eeprom[MT_EE_WIFI_CONF + band], 181 MT_EE_V2_BAND_SEL_6GHZ, 182 MT_EE_WIFI_CONF0_BAND_SEL); 183 } else { 184 phy->mt76->cap.has_5ghz = true; 185 u8p_replace_bits(&eeprom[MT_EE_WIFI_CONF + band], 186 MT_EE_V2_BAND_SEL_5GHZ, 187 MT_EE_WIFI_CONF0_BAND_SEL); 188 } 189 /* force to buffer mode */ 190 dev->flash_mode = true; 191 192 return; 193 default: 194 phy->mt76->cap.has_2ghz = true; 195 return; 196 } 197 } else if (val == MT_EE_BAND_SEL_DEFAULT && dev->dbdc_support) { 198 val = band ? MT_EE_BAND_SEL_5GHZ : MT_EE_BAND_SEL_2GHZ; 199 } 200 201 switch (val) { 202 case MT_EE_BAND_SEL_5GHZ: 203 phy->mt76->cap.has_5ghz = true; 204 break; 205 case MT_EE_BAND_SEL_2GHZ: 206 phy->mt76->cap.has_2ghz = true; 207 break; 208 default: 209 phy->mt76->cap.has_2ghz = true; 210 phy->mt76->cap.has_5ghz = true; 211 break; 212 } 213 } 214 215 void mt7915_eeprom_parse_hw_cap(struct mt7915_dev *dev, 216 struct mt7915_phy *phy) 217 { 218 u8 path, nss, nss_max = 4, *eeprom = dev->mt76.eeprom.data; 219 struct mt76_phy *mphy = phy->mt76; 220 u8 band = phy->mt76->band_idx; 221 222 mt7915_eeprom_parse_band_config(phy); 223 224 /* read tx/rx path from eeprom */ 225 if (is_mt7915(&dev->mt76)) { 226 path = FIELD_GET(MT_EE_WIFI_CONF0_TX_PATH, 227 eeprom[MT_EE_WIFI_CONF]); 228 } else { 229 path = FIELD_GET(MT_EE_WIFI_CONF0_TX_PATH, 230 eeprom[MT_EE_WIFI_CONF + band]); 231 } 232 233 if (!path || path > 4) 234 path = 4; 235 236 /* read tx/rx stream */ 237 nss = path; 238 if (dev->dbdc_support) { 239 if (is_mt7915(&dev->mt76)) { 240 path = min_t(u8, path, 2); 241 nss = FIELD_GET(MT_EE_WIFI_CONF3_TX_PATH_B0, 242 eeprom[MT_EE_WIFI_CONF + 3]); 243 if (band) 244 nss = FIELD_GET(MT_EE_WIFI_CONF3_TX_PATH_B1, 245 eeprom[MT_EE_WIFI_CONF + 3]); 246 } else { 247 nss = FIELD_GET(MT_EE_WIFI_CONF_STREAM_NUM, 248 eeprom[MT_EE_WIFI_CONF + 2 + band]); 249 } 250 251 if (!is_mt798x(&dev->mt76)) 252 nss_max = 2; 253 } 254 255 if (!nss) 256 nss = nss_max; 257 nss = min_t(u8, min_t(u8, nss_max, nss), path); 258 259 mphy->chainmask = BIT(path) - 1; 260 if (band) 261 mphy->chainmask <<= dev->chainshift; 262 mphy->antenna_mask = BIT(nss) - 1; 263 dev->chainmask |= mphy->chainmask; 264 dev->chainshift = hweight8(dev->mphy.chainmask); 265 } 266 267 int mt7915_eeprom_init(struct mt7915_dev *dev) 268 { 269 int ret; 270 271 ret = mt7915_eeprom_load(dev); 272 if (ret < 0) { 273 if (ret != -EINVAL) 274 return ret; 275 276 dev_warn(dev->mt76.dev, "eeprom load fail, use default bin\n"); 277 ret = mt7915_eeprom_load_default(dev); 278 if (ret) 279 return ret; 280 } 281 282 mt7915_eeprom_load_precal(dev); 283 mt7915_eeprom_parse_hw_cap(dev, &dev->phy); 284 memcpy(dev->mphy.macaddr, dev->mt76.eeprom.data + MT_EE_MAC_ADDR, 285 ETH_ALEN); 286 287 return mt76_eeprom_override(&dev->mphy); 288 } 289 290 int mt7915_eeprom_get_target_power(struct mt7915_dev *dev, 291 struct ieee80211_channel *chan, 292 u8 chain_idx) 293 { 294 u8 *eeprom = dev->mt76.eeprom.data; 295 int index, target_power; 296 bool tssi_on, is_7976; 297 298 if (chain_idx > 3) 299 return -EINVAL; 300 301 tssi_on = mt7915_tssi_enabled(dev, chan->band); 302 is_7976 = mt7915_check_adie(dev, false) || is_mt7916(&dev->mt76); 303 304 if (chan->band == NL80211_BAND_2GHZ) { 305 if (is_7976) { 306 index = MT_EE_TX0_POWER_2G_V2 + chain_idx; 307 target_power = eeprom[index]; 308 } else { 309 index = MT_EE_TX0_POWER_2G + chain_idx * 3; 310 target_power = eeprom[index]; 311 312 if (!tssi_on) 313 target_power += eeprom[index + 1]; 314 } 315 } else if (chan->band == NL80211_BAND_5GHZ) { 316 int group = mt7915_get_channel_group_5g(chan->hw_value, is_7976); 317 318 if (is_7976) { 319 index = MT_EE_TX0_POWER_5G_V2 + chain_idx * 5; 320 target_power = eeprom[index + group]; 321 } else { 322 index = MT_EE_TX0_POWER_5G + chain_idx * 12; 323 target_power = eeprom[index + group]; 324 325 if (!tssi_on) 326 target_power += eeprom[index + 8]; 327 } 328 } else { 329 int group = mt7915_get_channel_group_6g(chan->hw_value); 330 331 index = MT_EE_TX0_POWER_6G_V2 + chain_idx * 8; 332 target_power = is_7976 ? eeprom[index + group] : 0; 333 } 334 335 return target_power; 336 } 337 338 s8 mt7915_eeprom_get_power_delta(struct mt7915_dev *dev, int band) 339 { 340 u8 *eeprom = dev->mt76.eeprom.data; 341 u32 val, offs; 342 s8 delta; 343 bool is_7976 = mt7915_check_adie(dev, false) || is_mt7916(&dev->mt76); 344 345 if (band == NL80211_BAND_2GHZ) 346 offs = is_7976 ? MT_EE_RATE_DELTA_2G_V2 : MT_EE_RATE_DELTA_2G; 347 else if (band == NL80211_BAND_5GHZ) 348 offs = is_7976 ? MT_EE_RATE_DELTA_5G_V2 : MT_EE_RATE_DELTA_5G; 349 else 350 offs = is_7976 ? MT_EE_RATE_DELTA_6G_V2 : 0; 351 352 val = eeprom[offs]; 353 354 if (!offs || !(val & MT_EE_RATE_DELTA_EN)) 355 return 0; 356 357 delta = FIELD_GET(MT_EE_RATE_DELTA_MASK, val); 358 359 return val & MT_EE_RATE_DELTA_SIGN ? delta : -delta; 360 } 361 362 bool 363 mt7915_eeprom_has_background_radar(struct mt7915_dev *dev) 364 { 365 u8 val, buf[MT7915_EEPROM_BLOCK_SIZE]; 366 u8 band_sel, tx_path, rx_path; 367 int offs = MT_EE_WIFI_CONF + 1; 368 369 switch (mt76_chip(&dev->mt76)) { 370 case 0x7915: 371 return true; 372 case 0x7906: 373 /* read efuse to check background radar capability */ 374 if (mt7915_mcu_get_eeprom(dev, offs, buf)) 375 break; 376 377 val = buf[offs % MT7915_EEPROM_BLOCK_SIZE]; 378 band_sel = u8_get_bits(val, MT_EE_WIFI_CONF0_BAND_SEL); 379 tx_path = u8_get_bits(val, MT_EE_WIFI_CONF0_TX_PATH); 380 rx_path = u8_get_bits(val, MT_EE_WIFI_CONF0_RX_PATH); 381 382 return (band_sel == MT_EE_V2_BAND_SEL_5GHZ && 383 tx_path == rx_path && rx_path == 2); 384 case 0x7981: 385 case 0x7986: 386 default: 387 break; 388 } 389 390 return false; 391 } 392 393 const u8 mt7915_sku_group_len[] = { 394 [SKU_CCK] = 4, 395 [SKU_OFDM] = 8, 396 [SKU_HT_BW20] = 8, 397 [SKU_HT_BW40] = 9, 398 [SKU_VHT_BW20] = 12, 399 [SKU_VHT_BW40] = 12, 400 [SKU_VHT_BW80] = 12, 401 [SKU_VHT_BW160] = 12, 402 [SKU_HE_RU26] = 12, 403 [SKU_HE_RU52] = 12, 404 [SKU_HE_RU106] = 12, 405 [SKU_HE_RU242] = 12, 406 [SKU_HE_RU484] = 12, 407 [SKU_HE_RU996] = 12, 408 [SKU_HE_RU2x996] = 12 409 }; 410