• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: ISC
2 /* Copyright (C) 2020 MediaTek Inc. */
3 
4 #include "mt7921.h"
5 #include "eeprom.h"
6 
7 static int
mt7921_reg_set(void * data,u64 val)8 mt7921_reg_set(void *data, u64 val)
9 {
10 	struct mt7921_dev *dev = data;
11 
12 	mt7921_mutex_acquire(dev);
13 	mt76_wr(dev, dev->mt76.debugfs_reg, val);
14 	mt7921_mutex_release(dev);
15 
16 	return 0;
17 }
18 
19 static int
mt7921_reg_get(void * data,u64 * val)20 mt7921_reg_get(void *data, u64 *val)
21 {
22 	struct mt7921_dev *dev = data;
23 
24 	mt7921_mutex_acquire(dev);
25 	*val = mt76_rr(dev, dev->mt76.debugfs_reg);
26 	mt7921_mutex_release(dev);
27 
28 	return 0;
29 }
30 
31 DEFINE_DEBUGFS_ATTRIBUTE(fops_regval, mt7921_reg_get, mt7921_reg_set,
32 			 "0x%08llx\n");
33 static int
mt7921_fw_debug_set(void * data,u64 val)34 mt7921_fw_debug_set(void *data, u64 val)
35 {
36 	struct mt7921_dev *dev = data;
37 
38 	mt7921_mutex_acquire(dev);
39 
40 	dev->fw_debug = (u8)val;
41 	mt7921_mcu_fw_log_2_host(dev, dev->fw_debug);
42 
43 	mt7921_mutex_release(dev);
44 
45 	return 0;
46 }
47 
48 static int
mt7921_fw_debug_get(void * data,u64 * val)49 mt7921_fw_debug_get(void *data, u64 *val)
50 {
51 	struct mt7921_dev *dev = data;
52 
53 	*val = dev->fw_debug;
54 
55 	return 0;
56 }
57 
58 DEFINE_DEBUGFS_ATTRIBUTE(fops_fw_debug, mt7921_fw_debug_get,
59 			 mt7921_fw_debug_set, "%lld\n");
60 
61 static void
mt7921_ampdu_stat_read_phy(struct mt7921_phy * phy,struct seq_file * file)62 mt7921_ampdu_stat_read_phy(struct mt7921_phy *phy,
63 			   struct seq_file *file)
64 {
65 	struct mt7921_dev *dev = file->private;
66 	int bound[15], range[4], i;
67 
68 	if (!phy)
69 		return;
70 
71 	/* Tx ampdu stat */
72 	for (i = 0; i < ARRAY_SIZE(range); i++)
73 		range[i] = mt76_rr(dev, MT_MIB_ARNG(0, i));
74 
75 	for (i = 0; i < ARRAY_SIZE(bound); i++)
76 		bound[i] = MT_MIB_ARNCR_RANGE(range[i / 4], i % 4) + 1;
77 
78 	seq_printf(file, "\nPhy0\n");
79 
80 	seq_printf(file, "Length: %8d | ", bound[0]);
81 	for (i = 0; i < ARRAY_SIZE(bound) - 1; i++)
82 		seq_printf(file, "%3d  %3d | ", bound[i] + 1, bound[i + 1]);
83 
84 	seq_puts(file, "\nCount:  ");
85 	for (i = 0; i < ARRAY_SIZE(bound); i++)
86 		seq_printf(file, "%8d | ", dev->mt76.aggr_stats[i]);
87 	seq_puts(file, "\n");
88 
89 	seq_printf(file, "BA miss count: %d\n", phy->mib.ba_miss_cnt);
90 }
91 
92 static int
mt7921_tx_stats_show(struct seq_file * file,void * data)93 mt7921_tx_stats_show(struct seq_file *file, void *data)
94 {
95 	struct mt7921_dev *dev = file->private;
96 	int stat[8], i, n;
97 
98 	mt7921_mutex_acquire(dev);
99 
100 	mt7921_ampdu_stat_read_phy(&dev->phy, file);
101 
102 	/* Tx amsdu info */
103 	seq_puts(file, "Tx MSDU stat:\n");
104 	for (i = 0, n = 0; i < ARRAY_SIZE(stat); i++) {
105 		stat[i] = mt76_rr(dev,  MT_PLE_AMSDU_PACK_MSDU_CNT(i));
106 		n += stat[i];
107 	}
108 
109 	mt7921_mutex_release(dev);
110 
111 	for (i = 0; i < ARRAY_SIZE(stat); i++) {
112 		seq_printf(file, "AMSDU pack count of %d MSDU in TXD: 0x%x ",
113 			   i + 1, stat[i]);
114 		if (n != 0)
115 			seq_printf(file, "(%d%%)\n", stat[i] * 100 / n);
116 		else
117 			seq_puts(file, "\n");
118 	}
119 
120 	return 0;
121 }
122 
123 DEFINE_SHOW_ATTRIBUTE(mt7921_tx_stats);
124 
125 static int
mt7921_queues_acq(struct seq_file * s,void * data)126 mt7921_queues_acq(struct seq_file *s, void *data)
127 {
128 	struct mt7921_dev *dev = dev_get_drvdata(s->private);
129 	int i;
130 
131 	mt7921_mutex_acquire(dev);
132 
133 	for (i = 0; i < 4; i++) {
134 		u32 ctrl, val, qlen = 0;
135 		int j;
136 
137 		val = mt76_rr(dev, MT_PLE_AC_QEMPTY(i));
138 		ctrl = BIT(31) | BIT(11) | (i << 24);
139 
140 		for (j = 0; j < 32; j++) {
141 			if (val & BIT(j))
142 				continue;
143 
144 			mt76_wr(dev, MT_PLE_FL_Q0_CTRL, ctrl | j);
145 			qlen += mt76_get_field(dev, MT_PLE_FL_Q3_CTRL,
146 					       GENMASK(11, 0));
147 		}
148 		seq_printf(s, "AC%d: queued=%d\n", i, qlen);
149 	}
150 
151 	mt7921_mutex_release(dev);
152 
153 	return 0;
154 }
155 
156 static int
mt7921_queues_read(struct seq_file * s,void * data)157 mt7921_queues_read(struct seq_file *s, void *data)
158 {
159 	struct mt7921_dev *dev = dev_get_drvdata(s->private);
160 	struct {
161 		struct mt76_queue *q;
162 		char *queue;
163 	} queue_map[] = {
164 		{ dev->mphy.q_tx[MT_TXQ_BE],	 "WFDMA0" },
165 		{ dev->mt76.q_mcu[MT_MCUQ_WM],	 "MCUWM"  },
166 		{ dev->mt76.q_mcu[MT_MCUQ_FWDL], "MCUFWQ" },
167 	};
168 	int i;
169 
170 	for (i = 0; i < ARRAY_SIZE(queue_map); i++) {
171 		struct mt76_queue *q = queue_map[i].q;
172 
173 		if (!q)
174 			continue;
175 
176 		seq_printf(s,
177 			   "%s:	queued=%d head=%d tail=%d\n",
178 			   queue_map[i].queue, q->queued, q->head,
179 			   q->tail);
180 	}
181 
182 	return 0;
183 }
184 
185 static void
mt7921_seq_puts_array(struct seq_file * file,const char * str,s8 * val,int len)186 mt7921_seq_puts_array(struct seq_file *file, const char *str,
187 		      s8 *val, int len)
188 {
189 	int i;
190 
191 	seq_printf(file, "%-16s:", str);
192 	for (i = 0; i < len; i++)
193 		if (val[i] == 127)
194 			seq_printf(file, " %6s", "N.A");
195 		else
196 			seq_printf(file, " %6d", val[i]);
197 	seq_puts(file, "\n");
198 }
199 
200 #define mt7921_print_txpwr_entry(prefix, rate)				\
201 ({									\
202 	mt7921_seq_puts_array(s, #prefix " (user)",			\
203 			      txpwr.data[TXPWR_USER].rate,		\
204 			      ARRAY_SIZE(txpwr.data[TXPWR_USER].rate)); \
205 	mt7921_seq_puts_array(s, #prefix " (eeprom)",			\
206 			      txpwr.data[TXPWR_EEPROM].rate,		\
207 			      ARRAY_SIZE(txpwr.data[TXPWR_EEPROM].rate)); \
208 	mt7921_seq_puts_array(s, #prefix " (tmac)",			\
209 			      txpwr.data[TXPWR_MAC].rate,		\
210 			      ARRAY_SIZE(txpwr.data[TXPWR_MAC].rate));	\
211 })
212 
213 static int
mt7921_txpwr(struct seq_file * s,void * data)214 mt7921_txpwr(struct seq_file *s, void *data)
215 {
216 	struct mt7921_dev *dev = dev_get_drvdata(s->private);
217 	struct mt7921_txpwr txpwr;
218 	int ret;
219 
220 	mt7921_mutex_acquire(dev);
221 	ret = mt7921_get_txpwr_info(dev, &txpwr);
222 	mt7921_mutex_release(dev);
223 
224 	if (ret)
225 		return ret;
226 
227 	seq_printf(s, "Tx power table (channel %d)\n", txpwr.ch);
228 	seq_printf(s, "%-16s  %6s %6s %6s %6s\n",
229 		   " ", "1m", "2m", "5m", "11m");
230 	mt7921_print_txpwr_entry(CCK, cck);
231 
232 	seq_printf(s, "%-16s  %6s %6s %6s %6s %6s %6s %6s %6s\n",
233 		   " ", "6m", "9m", "12m", "18m", "24m", "36m",
234 		   "48m", "54m");
235 	mt7921_print_txpwr_entry(OFDM, ofdm);
236 
237 	seq_printf(s, "%-16s  %6s %6s %6s %6s %6s %6s %6s %6s\n",
238 		   " ", "mcs0", "mcs1", "mcs2", "mcs3", "mcs4", "mcs5",
239 		   "mcs6", "mcs7");
240 	mt7921_print_txpwr_entry(HT20, ht20);
241 
242 	seq_printf(s, "%-16s  %6s %6s %6s %6s %6s %6s %6s %6s %6s\n",
243 		   " ", "mcs0", "mcs1", "mcs2", "mcs3", "mcs4", "mcs5",
244 		   "mcs6", "mcs7", "mcs32");
245 	mt7921_print_txpwr_entry(HT40, ht40);
246 
247 	seq_printf(s, "%-16s  %6s %6s %6s %6s %6s %6s %6s %6s %6s %6s %6s %6s\n",
248 		   " ", "mcs0", "mcs1", "mcs2", "mcs3", "mcs4", "mcs5",
249 		   "mcs6", "mcs7", "mcs8", "mcs9", "mcs10", "mcs11");
250 	mt7921_print_txpwr_entry(VHT20, vht20);
251 	mt7921_print_txpwr_entry(VHT40, vht40);
252 	mt7921_print_txpwr_entry(VHT80, vht80);
253 	mt7921_print_txpwr_entry(VHT160, vht160);
254 	mt7921_print_txpwr_entry(HE26, he26);
255 	mt7921_print_txpwr_entry(HE52, he52);
256 	mt7921_print_txpwr_entry(HE106, he106);
257 	mt7921_print_txpwr_entry(HE242, he242);
258 	mt7921_print_txpwr_entry(HE484, he484);
259 	mt7921_print_txpwr_entry(HE996, he996);
260 	mt7921_print_txpwr_entry(HE996x2, he996x2);
261 
262 	return 0;
263 }
264 
265 static void
mt7921_pm_interface_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)266 mt7921_pm_interface_iter(void *priv, u8 *mac, struct ieee80211_vif *vif)
267 {
268 	struct mt7921_dev *dev = priv;
269 
270 	mt7921_mcu_set_beacon_filter(dev, vif, dev->pm.enable);
271 }
272 
273 static int
mt7921_pm_set(void * data,u64 val)274 mt7921_pm_set(void *data, u64 val)
275 {
276 	struct mt7921_dev *dev = data;
277 	struct mt76_connac_pm *pm = &dev->pm;
278 
279 	mutex_lock(&dev->mt76.mutex);
280 
281 	if (val == pm->enable)
282 		goto out;
283 
284 	if (!pm->enable) {
285 		pm->stats.last_wake_event = jiffies;
286 		pm->stats.last_doze_event = jiffies;
287 	}
288 	/* make sure the chip is awake here and ps_work is scheduled
289 	 * just at end of the this routine.
290 	 */
291 	pm->enable = false;
292 	mt76_connac_pm_wake(&dev->mphy, pm);
293 
294 	pm->enable = val;
295 	ieee80211_iterate_active_interfaces(mt76_hw(dev),
296 					    IEEE80211_IFACE_ITER_RESUME_ALL,
297 					    mt7921_pm_interface_iter, dev);
298 
299 	mt76_connac_mcu_set_deep_sleep(&dev->mt76, pm->ds_enable);
300 	mt76_connac_power_save_sched(&dev->mphy, pm);
301 out:
302 	mutex_unlock(&dev->mt76.mutex);
303 
304 	return 0;
305 }
306 
307 static int
mt7921_pm_get(void * data,u64 * val)308 mt7921_pm_get(void *data, u64 *val)
309 {
310 	struct mt7921_dev *dev = data;
311 
312 	*val = dev->pm.enable;
313 
314 	return 0;
315 }
316 
317 DEFINE_DEBUGFS_ATTRIBUTE(fops_pm, mt7921_pm_get, mt7921_pm_set, "%lld\n");
318 
319 static int
mt7921_deep_sleep_set(void * data,u64 val)320 mt7921_deep_sleep_set(void *data, u64 val)
321 {
322 	struct mt7921_dev *dev = data;
323 	struct mt76_connac_pm *pm = &dev->pm;
324 	bool enable = !!val;
325 
326 	mt7921_mutex_acquire(dev);
327 	if (pm->ds_enable != enable) {
328 		mt76_connac_mcu_set_deep_sleep(&dev->mt76, enable);
329 		pm->ds_enable = enable;
330 	}
331 	mt7921_mutex_release(dev);
332 
333 	return 0;
334 }
335 
336 static int
mt7921_deep_sleep_get(void * data,u64 * val)337 mt7921_deep_sleep_get(void *data, u64 *val)
338 {
339 	struct mt7921_dev *dev = data;
340 
341 	*val = dev->pm.ds_enable;
342 
343 	return 0;
344 }
345 
346 DEFINE_DEBUGFS_ATTRIBUTE(fops_ds, mt7921_deep_sleep_get,
347 			 mt7921_deep_sleep_set, "%lld\n");
348 
349 static int
mt7921_pm_stats(struct seq_file * s,void * data)350 mt7921_pm_stats(struct seq_file *s, void *data)
351 {
352 	struct mt7921_dev *dev = dev_get_drvdata(s->private);
353 	struct mt76_connac_pm *pm = &dev->pm;
354 
355 	unsigned long awake_time = pm->stats.awake_time;
356 	unsigned long doze_time = pm->stats.doze_time;
357 
358 	if (!test_bit(MT76_STATE_PM, &dev->mphy.state))
359 		awake_time += jiffies - pm->stats.last_wake_event;
360 	else
361 		doze_time += jiffies - pm->stats.last_doze_event;
362 
363 	seq_printf(s, "awake time: %14u\ndoze time: %15u\n",
364 		   jiffies_to_msecs(awake_time),
365 		   jiffies_to_msecs(doze_time));
366 
367 	seq_printf(s, "low power wakes: %9d\n", pm->stats.lp_wake);
368 
369 	return 0;
370 }
371 
372 static int
mt7921_pm_idle_timeout_set(void * data,u64 val)373 mt7921_pm_idle_timeout_set(void *data, u64 val)
374 {
375 	struct mt7921_dev *dev = data;
376 
377 	dev->pm.idle_timeout = msecs_to_jiffies(val);
378 
379 	return 0;
380 }
381 
382 static int
mt7921_pm_idle_timeout_get(void * data,u64 * val)383 mt7921_pm_idle_timeout_get(void *data, u64 *val)
384 {
385 	struct mt7921_dev *dev = data;
386 
387 	*val = jiffies_to_msecs(dev->pm.idle_timeout);
388 
389 	return 0;
390 }
391 
392 DEFINE_DEBUGFS_ATTRIBUTE(fops_pm_idle_timeout, mt7921_pm_idle_timeout_get,
393 			 mt7921_pm_idle_timeout_set, "%lld\n");
394 
mt7921_chip_reset(void * data,u64 val)395 static int mt7921_chip_reset(void *data, u64 val)
396 {
397 	struct mt7921_dev *dev = data;
398 	int ret = 0;
399 
400 	switch (val) {
401 	case 1:
402 		/* Reset wifisys directly. */
403 		mt7921_reset(&dev->mt76);
404 		break;
405 	default:
406 		/* Collect the core dump before reset wifisys. */
407 		mt7921_mutex_acquire(dev);
408 		ret = mt76_connac_mcu_chip_config(&dev->mt76);
409 		mt7921_mutex_release(dev);
410 		break;
411 	}
412 
413 	return ret;
414 }
415 
416 DEFINE_DEBUGFS_ATTRIBUTE(fops_reset, NULL, mt7921_chip_reset, "%lld\n");
417 
mt7921_init_debugfs(struct mt7921_dev * dev)418 int mt7921_init_debugfs(struct mt7921_dev *dev)
419 {
420 	struct dentry *dir;
421 
422 	dir = mt76_register_debugfs_fops(&dev->mt76, &fops_regval);
423 	if (!dir)
424 		return -ENOMEM;
425 
426 	debugfs_create_devm_seqfile(dev->mt76.dev, "queues", dir,
427 				    mt7921_queues_read);
428 	debugfs_create_devm_seqfile(dev->mt76.dev, "acq", dir,
429 				    mt7921_queues_acq);
430 	debugfs_create_devm_seqfile(dev->mt76.dev, "txpower_sku", dir,
431 				    mt7921_txpwr);
432 	debugfs_create_file("tx_stats", 0400, dir, dev, &mt7921_tx_stats_fops);
433 	debugfs_create_file("fw_debug", 0600, dir, dev, &fops_fw_debug);
434 	debugfs_create_file("runtime-pm", 0600, dir, dev, &fops_pm);
435 	debugfs_create_file("idle-timeout", 0600, dir, dev,
436 			    &fops_pm_idle_timeout);
437 	debugfs_create_file("chip_reset", 0600, dir, dev, &fops_reset);
438 	debugfs_create_devm_seqfile(dev->mt76.dev, "runtime_pm_stats", dir,
439 				    mt7921_pm_stats);
440 	debugfs_create_file("deep-sleep", 0600, dir, dev, &fops_ds);
441 
442 	return 0;
443 }
444