developer | 0f312e8 | 2022-11-01 12:31:52 +0800 | [diff] [blame] | 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 | |
| 69 | /* TODO: check free block event */ |
| 70 | mt7996_mcu_get_eeprom_free_block(dev, &free_block_num); |
| 71 | /* efuse info not enough */ |
| 72 | if (free_block_num >= 59) |
| 73 | return -EINVAL; |
| 74 | |
| 75 | /* read eeprom data from efuse */ |
| 76 | block_num = DIV_ROUND_UP(MT7996_EEPROM_SIZE, MT7996_EEPROM_BLOCK_SIZE); |
| 77 | for (i = 0; i < block_num; i++) |
| 78 | mt7996_mcu_get_eeprom(dev, i * MT7996_EEPROM_BLOCK_SIZE); |
| 79 | } |
| 80 | |
| 81 | return mt7996_check_eeprom(dev); |
| 82 | } |
| 83 | |
| 84 | static int mt7996_eeprom_parse_band_config(struct mt7996_phy *phy) |
| 85 | { |
| 86 | u8 *eeprom = phy->dev->mt76.eeprom.data; |
| 87 | u32 val = eeprom[MT_EE_WIFI_CONF]; |
| 88 | int ret = 0; |
| 89 | |
| 90 | switch (phy->mt76->band_idx) { |
| 91 | case MT_BAND1: |
| 92 | val = FIELD_GET(MT_EE_WIFI_CONF1_BAND_SEL, val); |
| 93 | break; |
| 94 | case MT_BAND2: |
| 95 | val = eeprom[MT_EE_WIFI_CONF + 1]; |
| 96 | val = FIELD_GET(MT_EE_WIFI_CONF2_BAND_SEL, val); |
| 97 | break; |
| 98 | default: |
| 99 | val = FIELD_GET(MT_EE_WIFI_CONF0_BAND_SEL, val); |
| 100 | break; |
| 101 | } |
| 102 | |
| 103 | switch (val) { |
| 104 | case MT_EE_BAND_SEL_2GHZ: |
| 105 | phy->mt76->cap.has_2ghz = true; |
| 106 | break; |
| 107 | case MT_EE_BAND_SEL_5GHZ: |
| 108 | phy->mt76->cap.has_5ghz = true; |
| 109 | break; |
| 110 | case MT_EE_BAND_SEL_6GHZ: |
| 111 | phy->mt76->cap.has_6ghz = true; |
| 112 | break; |
| 113 | case MT_EE_BAND_SEL_5GHZ_6GHZ: |
| 114 | phy->mt76->cap.has_5ghz = true; |
| 115 | phy->mt76->cap.has_6ghz = true; |
| 116 | break; |
| 117 | default: |
| 118 | ret = -EINVAL; |
| 119 | break; |
| 120 | } |
| 121 | |
| 122 | return ret; |
| 123 | } |
| 124 | |
| 125 | int mt7996_eeprom_parse_hw_cap(struct mt7996_dev *dev, struct mt7996_phy *phy) |
| 126 | { |
| 127 | u8 path, nss, band_idx = phy->mt76->band_idx; |
| 128 | u8 *eeprom = dev->mt76.eeprom.data; |
| 129 | struct mt76_phy *mphy = phy->mt76; |
| 130 | |
| 131 | switch (band_idx) { |
| 132 | case MT_BAND1: |
| 133 | path = FIELD_GET(MT_EE_WIFI_CONF2_TX_PATH_BAND1, |
| 134 | eeprom[MT_EE_WIFI_CONF + 2]); |
| 135 | nss = FIELD_GET(MT_EE_WIFI_CONF5_STREAM_NUM_BAND1, |
| 136 | eeprom[MT_EE_WIFI_CONF + 5]); |
| 137 | break; |
| 138 | case MT_BAND2: |
| 139 | path = FIELD_GET(MT_EE_WIFI_CONF2_TX_PATH_BAND2, |
| 140 | eeprom[MT_EE_WIFI_CONF + 2]); |
| 141 | nss = FIELD_GET(MT_EE_WIFI_CONF5_STREAM_NUM_BAND2, |
| 142 | eeprom[MT_EE_WIFI_CONF + 5]); |
| 143 | break; |
| 144 | default: |
| 145 | path = FIELD_GET(MT_EE_WIFI_CONF1_TX_PATH_BAND0, |
| 146 | eeprom[MT_EE_WIFI_CONF + 1]); |
| 147 | nss = FIELD_GET(MT_EE_WIFI_CONF4_STREAM_NUM_BAND0, |
| 148 | eeprom[MT_EE_WIFI_CONF + 4]); |
| 149 | break; |
| 150 | } |
| 151 | |
| 152 | if (!path || path > 4) |
| 153 | path = 4; |
| 154 | |
| 155 | nss = min_t(u8, min_t(u8, 4, nss), path); |
| 156 | |
| 157 | mphy->antenna_mask = BIT(nss) - 1; |
| 158 | mphy->chainmask = (BIT(path) - 1) << dev->chainshift[band_idx]; |
| 159 | dev->chainmask |= mphy->chainmask; |
| 160 | if (band_idx < MT_BAND2) |
| 161 | dev->chainshift[band_idx + 1] = dev->chainshift[band_idx] + |
| 162 | hweight16(mphy->chainmask); |
| 163 | |
| 164 | return mt7996_eeprom_parse_band_config(phy); |
| 165 | } |
| 166 | |
| 167 | int mt7996_eeprom_init(struct mt7996_dev *dev) |
| 168 | { |
| 169 | int ret; |
| 170 | |
| 171 | ret = mt7996_eeprom_load(dev); |
| 172 | if (ret < 0) { |
| 173 | if (ret != -EINVAL) |
| 174 | return ret; |
| 175 | |
| 176 | dev_warn(dev->mt76.dev, "eeprom load fail, use default bin\n"); |
| 177 | ret = mt7996_eeprom_load_default(dev); |
| 178 | if (ret) |
| 179 | return ret; |
| 180 | } |
| 181 | |
| 182 | ret = mt7996_eeprom_parse_hw_cap(dev, &dev->phy); |
| 183 | if (ret < 0) |
| 184 | return ret; |
| 185 | |
| 186 | memcpy(dev->mphy.macaddr, dev->mt76.eeprom.data + MT_EE_MAC_ADDR, ETH_ALEN); |
| 187 | mt76_eeprom_override(&dev->mphy); |
| 188 | |
| 189 | return 0; |
| 190 | } |
| 191 | |
| 192 | int mt7996_eeprom_get_target_power(struct mt7996_dev *dev, |
| 193 | struct ieee80211_channel *chan) |
| 194 | { |
| 195 | u8 *eeprom = dev->mt76.eeprom.data; |
| 196 | int target_power; |
| 197 | |
| 198 | if (chan->band == NL80211_BAND_5GHZ) |
| 199 | target_power = eeprom[MT_EE_TX0_POWER_5G + |
| 200 | mt7996_get_channel_group_5g(chan->hw_value)]; |
| 201 | else if (chan->band == NL80211_BAND_6GHZ) |
| 202 | target_power = eeprom[MT_EE_TX0_POWER_6G + |
| 203 | mt7996_get_channel_group_6g(chan->hw_value)]; |
| 204 | else |
| 205 | target_power = eeprom[MT_EE_TX0_POWER_2G]; |
| 206 | |
| 207 | return target_power; |
| 208 | } |
| 209 | |
| 210 | s8 mt7996_eeprom_get_power_delta(struct mt7996_dev *dev, int band) |
| 211 | { |
| 212 | u8 *eeprom = dev->mt76.eeprom.data; |
| 213 | u32 val; |
| 214 | s8 delta; |
| 215 | |
| 216 | if (band == NL80211_BAND_5GHZ) |
| 217 | val = eeprom[MT_EE_RATE_DELTA_5G]; |
| 218 | else if (band == NL80211_BAND_6GHZ) |
| 219 | val = eeprom[MT_EE_RATE_DELTA_6G]; |
| 220 | else |
| 221 | val = eeprom[MT_EE_RATE_DELTA_2G]; |
| 222 | |
| 223 | if (!(val & MT_EE_RATE_DELTA_EN)) |
| 224 | return 0; |
| 225 | |
| 226 | delta = FIELD_GET(MT_EE_RATE_DELTA_MASK, val); |
| 227 | |
| 228 | return val & MT_EE_RATE_DELTA_SIGN ? delta : -delta; |
| 229 | } |