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 
mt7996_check_eeprom(struct mt7996_dev * dev)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 
mt7996_eeprom_name(struct mt7996_dev * dev)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
mt7996_eeprom_load_default(struct mt7996_dev * dev)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 
mt7996_eeprom_load(struct mt7996_dev * dev)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 
mt7996_eeprom_parse_efuse_hw_cap(struct mt7996_dev * dev)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 
mt7996_eeprom_parse_band_config(struct mt7996_phy * phy)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 
mt7996_eeprom_parse_hw_cap(struct mt7996_dev * dev,struct mt7996_phy * phy)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 
mt7996_eeprom_init(struct mt7996_dev * dev)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 
mt7996_eeprom_get_target_power(struct mt7996_dev * dev,struct ieee80211_channel * chan)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 
mt7996_eeprom_get_power_delta(struct mt7996_dev * dev,int band)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