198686cd2SShayne Chen // SPDX-License-Identifier: ISC
298686cd2SShayne Chen /*
398686cd2SShayne Chen * Copyright (C) 2022 MediaTek Inc.
498686cd2SShayne Chen */
598686cd2SShayne Chen
698686cd2SShayne Chen #include <linux/firmware.h>
798686cd2SShayne Chen #include "mt7996.h"
898686cd2SShayne Chen #include "eeprom.h"
998686cd2SShayne Chen
mt7996_check_eeprom(struct mt7996_dev * dev)1098686cd2SShayne Chen static int mt7996_check_eeprom(struct mt7996_dev *dev)
1198686cd2SShayne Chen {
1298686cd2SShayne Chen u8 *eeprom = dev->mt76.eeprom.data;
1398686cd2SShayne Chen u16 val = get_unaligned_le16(eeprom);
1498686cd2SShayne Chen
1598686cd2SShayne Chen switch (val) {
1698686cd2SShayne Chen case 0x7990:
1798686cd2SShayne Chen return 0;
1898686cd2SShayne Chen default:
1998686cd2SShayne Chen return -EINVAL;
2098686cd2SShayne Chen }
2198686cd2SShayne Chen }
2298686cd2SShayne Chen
mt7996_eeprom_name(struct mt7996_dev * dev)2398686cd2SShayne Chen static char *mt7996_eeprom_name(struct mt7996_dev *dev)
2498686cd2SShayne Chen {
2598686cd2SShayne Chen /* reserve for future variants */
2698686cd2SShayne Chen return MT7996_EEPROM_DEFAULT;
2798686cd2SShayne Chen }
2898686cd2SShayne Chen
2998686cd2SShayne Chen static int
mt7996_eeprom_load_default(struct mt7996_dev * dev)3098686cd2SShayne Chen mt7996_eeprom_load_default(struct mt7996_dev *dev)
3198686cd2SShayne Chen {
3298686cd2SShayne Chen u8 *eeprom = dev->mt76.eeprom.data;
3398686cd2SShayne Chen const struct firmware *fw = NULL;
3498686cd2SShayne Chen int ret;
3598686cd2SShayne Chen
3698686cd2SShayne Chen ret = request_firmware(&fw, mt7996_eeprom_name(dev), dev->mt76.dev);
3798686cd2SShayne Chen if (ret)
3898686cd2SShayne Chen return ret;
3998686cd2SShayne Chen
4098686cd2SShayne Chen if (!fw || !fw->data) {
4198686cd2SShayne Chen dev_err(dev->mt76.dev, "Invalid default bin\n");
4298686cd2SShayne Chen ret = -EINVAL;
4398686cd2SShayne Chen goto out;
4498686cd2SShayne Chen }
4598686cd2SShayne Chen
4698686cd2SShayne Chen memcpy(eeprom, fw->data, MT7996_EEPROM_SIZE);
4798686cd2SShayne Chen dev->flash_mode = true;
4898686cd2SShayne Chen
4998686cd2SShayne Chen out:
5098686cd2SShayne Chen release_firmware(fw);
5198686cd2SShayne Chen
5298686cd2SShayne Chen return ret;
5398686cd2SShayne Chen }
5498686cd2SShayne Chen
mt7996_eeprom_load(struct mt7996_dev * dev)5598686cd2SShayne Chen static int mt7996_eeprom_load(struct mt7996_dev *dev)
5698686cd2SShayne Chen {
5798686cd2SShayne Chen int ret;
5898686cd2SShayne Chen
5998686cd2SShayne Chen ret = mt76_eeprom_init(&dev->mt76, MT7996_EEPROM_SIZE);
6098686cd2SShayne Chen if (ret < 0)
6198686cd2SShayne Chen return ret;
6298686cd2SShayne Chen
6398686cd2SShayne Chen if (ret) {
6498686cd2SShayne Chen dev->flash_mode = true;
6598686cd2SShayne Chen } else {
6698686cd2SShayne Chen u8 free_block_num;
6798686cd2SShayne Chen u32 block_num, i;
68783ef7daSRyder Lee u32 eeprom_blk_size = MT7996_EEPROM_BLOCK_SIZE;
6998686cd2SShayne Chen
70783ef7daSRyder Lee ret = mt7996_mcu_get_eeprom_free_block(dev, &free_block_num);
71783ef7daSRyder Lee if (ret < 0)
72783ef7daSRyder Lee return ret;
73783ef7daSRyder Lee
74783ef7daSRyder Lee /* efuse info isn't enough */
7598686cd2SShayne Chen if (free_block_num >= 59)
7698686cd2SShayne Chen return -EINVAL;
7798686cd2SShayne Chen
7898686cd2SShayne Chen /* read eeprom data from efuse */
79783ef7daSRyder Lee block_num = DIV_ROUND_UP(MT7996_EEPROM_SIZE, eeprom_blk_size);
80783ef7daSRyder Lee for (i = 0; i < block_num; i++) {
81783ef7daSRyder Lee ret = mt7996_mcu_get_eeprom(dev, i * eeprom_blk_size);
82783ef7daSRyder Lee if (ret < 0)
83783ef7daSRyder Lee return ret;
84783ef7daSRyder Lee }
8598686cd2SShayne Chen }
8698686cd2SShayne Chen
8798686cd2SShayne Chen return mt7996_check_eeprom(dev);
8898686cd2SShayne Chen }
8998686cd2SShayne Chen
mt7996_eeprom_parse_efuse_hw_cap(struct mt7996_dev * dev)90*5d33053bSShayne Chen static int mt7996_eeprom_parse_efuse_hw_cap(struct mt7996_dev *dev)
91*5d33053bSShayne Chen {
92*5d33053bSShayne Chen #define MODE_HE_ONLY BIT(0)
93*5d33053bSShayne Chen #define WTBL_SIZE_GROUP GENMASK(31, 28)
94*5d33053bSShayne Chen u32 cap = 0;
95*5d33053bSShayne Chen int ret;
96*5d33053bSShayne Chen
97*5d33053bSShayne Chen ret = mt7996_mcu_get_chip_config(dev, &cap);
98*5d33053bSShayne Chen if (ret)
99*5d33053bSShayne Chen return ret;
100*5d33053bSShayne Chen
101*5d33053bSShayne Chen if (cap) {
102*5d33053bSShayne Chen dev->has_eht = !(cap & MODE_HE_ONLY);
103*5d33053bSShayne Chen dev->wtbl_size_group = u32_get_bits(cap, WTBL_SIZE_GROUP);
104*5d33053bSShayne Chen }
105*5d33053bSShayne Chen
106*5d33053bSShayne Chen if (dev->wtbl_size_group < 2 || dev->wtbl_size_group > 4)
107*5d33053bSShayne Chen dev->wtbl_size_group = 2; /* set default */
108*5d33053bSShayne Chen
109*5d33053bSShayne Chen return 0;
110*5d33053bSShayne Chen }
111*5d33053bSShayne Chen
mt7996_eeprom_parse_band_config(struct mt7996_phy * phy)11298686cd2SShayne Chen static int mt7996_eeprom_parse_band_config(struct mt7996_phy *phy)
11398686cd2SShayne Chen {
11498686cd2SShayne Chen u8 *eeprom = phy->dev->mt76.eeprom.data;
11598686cd2SShayne Chen u32 val = eeprom[MT_EE_WIFI_CONF];
11698686cd2SShayne Chen int ret = 0;
11798686cd2SShayne Chen
11898686cd2SShayne Chen switch (phy->mt76->band_idx) {
11998686cd2SShayne Chen case MT_BAND1:
12098686cd2SShayne Chen val = FIELD_GET(MT_EE_WIFI_CONF1_BAND_SEL, val);
12198686cd2SShayne Chen break;
12298686cd2SShayne Chen case MT_BAND2:
12398686cd2SShayne Chen val = eeprom[MT_EE_WIFI_CONF + 1];
12498686cd2SShayne Chen val = FIELD_GET(MT_EE_WIFI_CONF2_BAND_SEL, val);
12598686cd2SShayne Chen break;
12698686cd2SShayne Chen default:
12798686cd2SShayne Chen val = FIELD_GET(MT_EE_WIFI_CONF0_BAND_SEL, val);
12898686cd2SShayne Chen break;
12998686cd2SShayne Chen }
13098686cd2SShayne Chen
13198686cd2SShayne Chen switch (val) {
13298686cd2SShayne Chen case MT_EE_BAND_SEL_2GHZ:
13398686cd2SShayne Chen phy->mt76->cap.has_2ghz = true;
13498686cd2SShayne Chen break;
13598686cd2SShayne Chen case MT_EE_BAND_SEL_5GHZ:
13698686cd2SShayne Chen phy->mt76->cap.has_5ghz = true;
13798686cd2SShayne Chen break;
13898686cd2SShayne Chen case MT_EE_BAND_SEL_6GHZ:
13998686cd2SShayne Chen phy->mt76->cap.has_6ghz = true;
14098686cd2SShayne Chen break;
14198686cd2SShayne Chen default:
14298686cd2SShayne Chen ret = -EINVAL;
14398686cd2SShayne Chen break;
14498686cd2SShayne Chen }
14598686cd2SShayne Chen
14698686cd2SShayne Chen return ret;
14798686cd2SShayne Chen }
14898686cd2SShayne Chen
mt7996_eeprom_parse_hw_cap(struct mt7996_dev * dev,struct mt7996_phy * phy)14998686cd2SShayne Chen int mt7996_eeprom_parse_hw_cap(struct mt7996_dev *dev, struct mt7996_phy *phy)
15098686cd2SShayne Chen {
15198686cd2SShayne Chen u8 path, nss, band_idx = phy->mt76->band_idx;
15298686cd2SShayne Chen u8 *eeprom = dev->mt76.eeprom.data;
15398686cd2SShayne Chen struct mt76_phy *mphy = phy->mt76;
154*5d33053bSShayne Chen int ret;
15598686cd2SShayne Chen
15698686cd2SShayne Chen switch (band_idx) {
15798686cd2SShayne Chen case MT_BAND1:
15898686cd2SShayne Chen path = FIELD_GET(MT_EE_WIFI_CONF2_TX_PATH_BAND1,
15998686cd2SShayne Chen eeprom[MT_EE_WIFI_CONF + 2]);
16098686cd2SShayne Chen nss = FIELD_GET(MT_EE_WIFI_CONF5_STREAM_NUM_BAND1,
16198686cd2SShayne Chen eeprom[MT_EE_WIFI_CONF + 5]);
16298686cd2SShayne Chen break;
16398686cd2SShayne Chen case MT_BAND2:
16498686cd2SShayne Chen path = FIELD_GET(MT_EE_WIFI_CONF2_TX_PATH_BAND2,
16598686cd2SShayne Chen eeprom[MT_EE_WIFI_CONF + 2]);
16698686cd2SShayne Chen nss = FIELD_GET(MT_EE_WIFI_CONF5_STREAM_NUM_BAND2,
16798686cd2SShayne Chen eeprom[MT_EE_WIFI_CONF + 5]);
16898686cd2SShayne Chen break;
16998686cd2SShayne Chen default:
17098686cd2SShayne Chen path = FIELD_GET(MT_EE_WIFI_CONF1_TX_PATH_BAND0,
17198686cd2SShayne Chen eeprom[MT_EE_WIFI_CONF + 1]);
17298686cd2SShayne Chen nss = FIELD_GET(MT_EE_WIFI_CONF4_STREAM_NUM_BAND0,
17398686cd2SShayne Chen eeprom[MT_EE_WIFI_CONF + 4]);
17498686cd2SShayne Chen break;
17598686cd2SShayne Chen }
17698686cd2SShayne Chen
17798686cd2SShayne Chen if (!path || path > 4)
17898686cd2SShayne Chen path = 4;
17998686cd2SShayne Chen
18098686cd2SShayne Chen nss = min_t(u8, min_t(u8, 4, nss), path);
18198686cd2SShayne Chen
18298686cd2SShayne Chen mphy->antenna_mask = BIT(nss) - 1;
18398686cd2SShayne Chen mphy->chainmask = (BIT(path) - 1) << dev->chainshift[band_idx];
18498686cd2SShayne Chen dev->chainmask |= mphy->chainmask;
18598686cd2SShayne Chen if (band_idx < MT_BAND2)
18698686cd2SShayne Chen dev->chainshift[band_idx + 1] = dev->chainshift[band_idx] +
18798686cd2SShayne Chen hweight16(mphy->chainmask);
18898686cd2SShayne Chen
189*5d33053bSShayne Chen ret = mt7996_eeprom_parse_efuse_hw_cap(dev);
190*5d33053bSShayne Chen if (ret)
191*5d33053bSShayne Chen return ret;
192*5d33053bSShayne Chen
19398686cd2SShayne Chen return mt7996_eeprom_parse_band_config(phy);
19498686cd2SShayne Chen }
19598686cd2SShayne Chen
mt7996_eeprom_init(struct mt7996_dev * dev)19698686cd2SShayne Chen int mt7996_eeprom_init(struct mt7996_dev *dev)
19798686cd2SShayne Chen {
19898686cd2SShayne Chen int ret;
19998686cd2SShayne Chen
20098686cd2SShayne Chen ret = mt7996_eeprom_load(dev);
20198686cd2SShayne Chen if (ret < 0) {
20298686cd2SShayne Chen if (ret != -EINVAL)
20398686cd2SShayne Chen return ret;
20498686cd2SShayne Chen
20598686cd2SShayne Chen dev_warn(dev->mt76.dev, "eeprom load fail, use default bin\n");
20698686cd2SShayne Chen ret = mt7996_eeprom_load_default(dev);
20798686cd2SShayne Chen if (ret)
20898686cd2SShayne Chen return ret;
20998686cd2SShayne Chen }
21098686cd2SShayne Chen
21198686cd2SShayne Chen ret = mt7996_eeprom_parse_hw_cap(dev, &dev->phy);
21298686cd2SShayne Chen if (ret < 0)
21398686cd2SShayne Chen return ret;
21498686cd2SShayne Chen
21598686cd2SShayne Chen memcpy(dev->mphy.macaddr, dev->mt76.eeprom.data + MT_EE_MAC_ADDR, ETH_ALEN);
21698686cd2SShayne Chen mt76_eeprom_override(&dev->mphy);
21798686cd2SShayne Chen
21898686cd2SShayne Chen return 0;
21998686cd2SShayne Chen }
22098686cd2SShayne Chen
mt7996_eeprom_get_target_power(struct mt7996_dev * dev,struct ieee80211_channel * chan)22198686cd2SShayne Chen int mt7996_eeprom_get_target_power(struct mt7996_dev *dev,
22298686cd2SShayne Chen struct ieee80211_channel *chan)
22398686cd2SShayne Chen {
22498686cd2SShayne Chen u8 *eeprom = dev->mt76.eeprom.data;
22598686cd2SShayne Chen int target_power;
22698686cd2SShayne Chen
22798686cd2SShayne Chen if (chan->band == NL80211_BAND_5GHZ)
22898686cd2SShayne Chen target_power = eeprom[MT_EE_TX0_POWER_5G +
22998686cd2SShayne Chen mt7996_get_channel_group_5g(chan->hw_value)];
23098686cd2SShayne Chen else if (chan->band == NL80211_BAND_6GHZ)
23198686cd2SShayne Chen target_power = eeprom[MT_EE_TX0_POWER_6G +
23298686cd2SShayne Chen mt7996_get_channel_group_6g(chan->hw_value)];
23398686cd2SShayne Chen else
23498686cd2SShayne Chen target_power = eeprom[MT_EE_TX0_POWER_2G];
23598686cd2SShayne Chen
23698686cd2SShayne Chen return target_power;
23798686cd2SShayne Chen }
23898686cd2SShayne Chen
mt7996_eeprom_get_power_delta(struct mt7996_dev * dev,int band)23998686cd2SShayne Chen s8 mt7996_eeprom_get_power_delta(struct mt7996_dev *dev, int band)
24098686cd2SShayne Chen {
24198686cd2SShayne Chen u8 *eeprom = dev->mt76.eeprom.data;
24298686cd2SShayne Chen u32 val;
24398686cd2SShayne Chen s8 delta;
24498686cd2SShayne Chen
24598686cd2SShayne Chen if (band == NL80211_BAND_5GHZ)
24698686cd2SShayne Chen val = eeprom[MT_EE_RATE_DELTA_5G];
24798686cd2SShayne Chen else if (band == NL80211_BAND_6GHZ)
24898686cd2SShayne Chen val = eeprom[MT_EE_RATE_DELTA_6G];
24998686cd2SShayne Chen else
25098686cd2SShayne Chen val = eeprom[MT_EE_RATE_DELTA_2G];
25198686cd2SShayne Chen
25298686cd2SShayne Chen if (!(val & MT_EE_RATE_DELTA_EN))
25398686cd2SShayne Chen return 0;
25498686cd2SShayne Chen
25598686cd2SShayne Chen delta = FIELD_GET(MT_EE_RATE_DELTA_MASK, val);
25698686cd2SShayne Chen
25798686cd2SShayne Chen return val & MT_EE_RATE_DELTA_SIGN ? delta : -delta;
25898686cd2SShayne Chen }
259