1 // SPDX-License-Identifier: ISC 2 /* 3 * Copyright (C) 2022 MediaTek Inc. 4 */ 5 6 #include <linux/firmware.h> 7 #include "mt7996.h" 8 #include "eeprom.h" 9 10 static int mt7996_check_eeprom(struct mt7996_dev *dev) 11 { 12 u8 *eeprom = dev->mt76.eeprom.data; 13 u16 val = get_unaligned_le16(eeprom); 14 15 switch (val) { 16 case 0x7990: 17 return 0; 18 default: 19 return -EINVAL; 20 } 21 } 22 23 static char *mt7996_eeprom_name(struct mt7996_dev *dev) 24 { 25 /* reserve for future variants */ 26 return MT7996_EEPROM_DEFAULT; 27 } 28 29 static int 30 mt7996_eeprom_load_default(struct mt7996_dev *dev) 31 { 32 u8 *eeprom = dev->mt76.eeprom.data; 33 const struct firmware *fw = NULL; 34 int ret; 35 36 ret = request_firmware(&fw, mt7996_eeprom_name(dev), dev->mt76.dev); 37 if (ret) 38 return ret; 39 40 if (!fw || !fw->data) { 41 dev_err(dev->mt76.dev, "Invalid default bin\n"); 42 ret = -EINVAL; 43 goto out; 44 } 45 46 memcpy(eeprom, fw->data, MT7996_EEPROM_SIZE); 47 dev->flash_mode = true; 48 49 out: 50 release_firmware(fw); 51 52 return ret; 53 } 54 55 static int mt7996_eeprom_load(struct mt7996_dev *dev) 56 { 57 int ret; 58 59 ret = mt76_eeprom_init(&dev->mt76, MT7996_EEPROM_SIZE); 60 if (ret < 0) 61 return ret; 62 63 if (ret) { 64 dev->flash_mode = true; 65 } else { 66 u8 free_block_num; 67 u32 block_num, i; 68 u32 eeprom_blk_size = MT7996_EEPROM_BLOCK_SIZE; 69 70 ret = mt7996_mcu_get_eeprom_free_block(dev, &free_block_num); 71 if (ret < 0) 72 return ret; 73 74 /* efuse info isn't enough */ 75 if (free_block_num >= 59) 76 return -EINVAL; 77 78 /* read eeprom data from efuse */ 79 block_num = DIV_ROUND_UP(MT7996_EEPROM_SIZE, eeprom_blk_size); 80 for (i = 0; i < block_num; i++) { 81 ret = mt7996_mcu_get_eeprom(dev, i * eeprom_blk_size); 82 if (ret < 0) 83 return ret; 84 } 85 } 86 87 return mt7996_check_eeprom(dev); 88 } 89 90 static int mt7996_eeprom_parse_efuse_hw_cap(struct mt7996_dev *dev) 91 { 92 #define MODE_HE_ONLY BIT(0) 93 #define WTBL_SIZE_GROUP GENMASK(31, 28) 94 u32 cap = 0; 95 int ret; 96 97 ret = mt7996_mcu_get_chip_config(dev, &cap); 98 if (ret) 99 return ret; 100 101 if (cap) { 102 dev->has_eht = !(cap & MODE_HE_ONLY); 103 dev->wtbl_size_group = u32_get_bits(cap, WTBL_SIZE_GROUP); 104 } 105 106 if (dev->wtbl_size_group < 2 || dev->wtbl_size_group > 4) 107 dev->wtbl_size_group = 2; /* set default */ 108 109 return 0; 110 } 111 112 static int mt7996_eeprom_parse_band_config(struct mt7996_phy *phy) 113 { 114 u8 *eeprom = phy->dev->mt76.eeprom.data; 115 u32 val = eeprom[MT_EE_WIFI_CONF]; 116 int ret = 0; 117 118 switch (phy->mt76->band_idx) { 119 case MT_BAND1: 120 val = FIELD_GET(MT_EE_WIFI_CONF1_BAND_SEL, val); 121 break; 122 case MT_BAND2: 123 val = eeprom[MT_EE_WIFI_CONF + 1]; 124 val = FIELD_GET(MT_EE_WIFI_CONF2_BAND_SEL, val); 125 break; 126 default: 127 val = FIELD_GET(MT_EE_WIFI_CONF0_BAND_SEL, val); 128 break; 129 } 130 131 switch (val) { 132 case MT_EE_BAND_SEL_2GHZ: 133 phy->mt76->cap.has_2ghz = true; 134 break; 135 case MT_EE_BAND_SEL_5GHZ: 136 phy->mt76->cap.has_5ghz = true; 137 break; 138 case MT_EE_BAND_SEL_6GHZ: 139 phy->mt76->cap.has_6ghz = true; 140 break; 141 default: 142 ret = -EINVAL; 143 break; 144 } 145 146 return ret; 147 } 148 149 int mt7996_eeprom_parse_hw_cap(struct mt7996_dev *dev, struct mt7996_phy *phy) 150 { 151 u8 path, nss, band_idx = phy->mt76->band_idx; 152 u8 *eeprom = dev->mt76.eeprom.data; 153 struct mt76_phy *mphy = phy->mt76; 154 int ret; 155 156 switch (band_idx) { 157 case MT_BAND1: 158 path = FIELD_GET(MT_EE_WIFI_CONF2_TX_PATH_BAND1, 159 eeprom[MT_EE_WIFI_CONF + 2]); 160 nss = FIELD_GET(MT_EE_WIFI_CONF5_STREAM_NUM_BAND1, 161 eeprom[MT_EE_WIFI_CONF + 5]); 162 break; 163 case MT_BAND2: 164 path = FIELD_GET(MT_EE_WIFI_CONF2_TX_PATH_BAND2, 165 eeprom[MT_EE_WIFI_CONF + 2]); 166 nss = FIELD_GET(MT_EE_WIFI_CONF5_STREAM_NUM_BAND2, 167 eeprom[MT_EE_WIFI_CONF + 5]); 168 break; 169 default: 170 path = FIELD_GET(MT_EE_WIFI_CONF1_TX_PATH_BAND0, 171 eeprom[MT_EE_WIFI_CONF + 1]); 172 nss = FIELD_GET(MT_EE_WIFI_CONF4_STREAM_NUM_BAND0, 173 eeprom[MT_EE_WIFI_CONF + 4]); 174 break; 175 } 176 177 if (!path || path > 4) 178 path = 4; 179 180 nss = min_t(u8, min_t(u8, 4, nss), path); 181 182 mphy->antenna_mask = BIT(nss) - 1; 183 mphy->chainmask = (BIT(path) - 1) << dev->chainshift[band_idx]; 184 dev->chainmask |= mphy->chainmask; 185 if (band_idx < MT_BAND2) 186 dev->chainshift[band_idx + 1] = dev->chainshift[band_idx] + 187 hweight16(mphy->chainmask); 188 189 ret = mt7996_eeprom_parse_efuse_hw_cap(dev); 190 if (ret) 191 return ret; 192 193 return mt7996_eeprom_parse_band_config(phy); 194 } 195 196 int mt7996_eeprom_init(struct mt7996_dev *dev) 197 { 198 int ret; 199 200 ret = mt7996_eeprom_load(dev); 201 if (ret < 0) { 202 if (ret != -EINVAL) 203 return ret; 204 205 dev_warn(dev->mt76.dev, "eeprom load fail, use default bin\n"); 206 ret = mt7996_eeprom_load_default(dev); 207 if (ret) 208 return ret; 209 } 210 211 ret = mt7996_eeprom_parse_hw_cap(dev, &dev->phy); 212 if (ret < 0) 213 return ret; 214 215 memcpy(dev->mphy.macaddr, dev->mt76.eeprom.data + MT_EE_MAC_ADDR, ETH_ALEN); 216 mt76_eeprom_override(&dev->mphy); 217 218 return 0; 219 } 220 221 int mt7996_eeprom_get_target_power(struct mt7996_dev *dev, 222 struct ieee80211_channel *chan) 223 { 224 u8 *eeprom = dev->mt76.eeprom.data; 225 int target_power; 226 227 if (chan->band == NL80211_BAND_5GHZ) 228 target_power = eeprom[MT_EE_TX0_POWER_5G + 229 mt7996_get_channel_group_5g(chan->hw_value)]; 230 else if (chan->band == NL80211_BAND_6GHZ) 231 target_power = eeprom[MT_EE_TX0_POWER_6G + 232 mt7996_get_channel_group_6g(chan->hw_value)]; 233 else 234 target_power = eeprom[MT_EE_TX0_POWER_2G]; 235 236 return target_power; 237 } 238 239 s8 mt7996_eeprom_get_power_delta(struct mt7996_dev *dev, int band) 240 { 241 u8 *eeprom = dev->mt76.eeprom.data; 242 u32 val; 243 s8 delta; 244 245 if (band == NL80211_BAND_5GHZ) 246 val = eeprom[MT_EE_RATE_DELTA_5G]; 247 else if (band == NL80211_BAND_6GHZ) 248 val = eeprom[MT_EE_RATE_DELTA_6G]; 249 else 250 val = eeprom[MT_EE_RATE_DELTA_2G]; 251 252 if (!(val & MT_EE_RATE_DELTA_EN)) 253 return 0; 254 255 delta = FIELD_GET(MT_EE_RATE_DELTA_MASK, val); 256 257 return val & MT_EE_RATE_DELTA_SIGN ? delta : -delta; 258 } 259