461 lines
11 KiB
C
461 lines
11 KiB
C
// SPDX-License-Identifier: ISC
|
|
/* Copyright (C) 2020 MediaTek Inc. */
|
|
|
|
#include "mt7921.h"
|
|
|
|
static int
|
|
mt7921_reg_set(void *data, u64 val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
mt7921_mutex_acquire(dev);
|
|
mt76_wr(dev, dev->mt76.debugfs_reg, val);
|
|
mt7921_mutex_release(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_reg_get(void *data, u64 *val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
mt7921_mutex_acquire(dev);
|
|
*val = mt76_rr(dev, dev->mt76.debugfs_reg);
|
|
mt7921_mutex_release(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
DEFINE_DEBUGFS_ATTRIBUTE(fops_regval, mt7921_reg_get, mt7921_reg_set,
|
|
"0x%08llx\n");
|
|
static int
|
|
mt7921_fw_debug_set(void *data, u64 val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
mt7921_mutex_acquire(dev);
|
|
|
|
dev->fw_debug = (u8)val;
|
|
mt7921_mcu_fw_log_2_host(dev, dev->fw_debug);
|
|
|
|
mt7921_mutex_release(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_fw_debug_get(void *data, u64 *val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
*val = dev->fw_debug;
|
|
|
|
return 0;
|
|
}
|
|
|
|
DEFINE_DEBUGFS_ATTRIBUTE(fops_fw_debug, mt7921_fw_debug_get,
|
|
mt7921_fw_debug_set, "%lld\n");
|
|
|
|
static void
|
|
mt7921_ampdu_stat_read_phy(struct mt7921_phy *phy,
|
|
struct seq_file *file)
|
|
{
|
|
struct mt7921_dev *dev = file->private;
|
|
int bound[15], range[4], i;
|
|
|
|
if (!phy)
|
|
return;
|
|
|
|
mt7921_mac_update_mib_stats(phy);
|
|
|
|
/* Tx ampdu stat */
|
|
for (i = 0; i < ARRAY_SIZE(range); i++)
|
|
range[i] = mt76_rr(dev, MT_MIB_ARNG(0, i));
|
|
|
|
for (i = 0; i < ARRAY_SIZE(bound); i++)
|
|
bound[i] = MT_MIB_ARNCR_RANGE(range[i / 4], i % 4) + 1;
|
|
|
|
seq_printf(file, "\nPhy0\n");
|
|
|
|
seq_printf(file, "Length: %8d | ", bound[0]);
|
|
for (i = 0; i < ARRAY_SIZE(bound) - 1; i++)
|
|
seq_printf(file, "%3d %3d | ", bound[i] + 1, bound[i + 1]);
|
|
|
|
seq_puts(file, "\nCount: ");
|
|
for (i = 0; i < ARRAY_SIZE(bound); i++)
|
|
seq_printf(file, "%8d | ", phy->mt76->aggr_stats[i]);
|
|
seq_puts(file, "\n");
|
|
|
|
seq_printf(file, "BA miss count: %d\n", phy->mib.ba_miss_cnt);
|
|
}
|
|
|
|
static int
|
|
mt7921_tx_stats_show(struct seq_file *file, void *data)
|
|
{
|
|
struct mt7921_dev *dev = file->private;
|
|
struct mt7921_phy *phy = &dev->phy;
|
|
struct mib_stats *mib = &phy->mib;
|
|
int i;
|
|
|
|
mt7921_mutex_acquire(dev);
|
|
|
|
mt7921_ampdu_stat_read_phy(phy, file);
|
|
|
|
seq_puts(file, "Tx MSDU stat:\n");
|
|
for (i = 0; i < ARRAY_SIZE(mib->tx_amsdu); i++) {
|
|
seq_printf(file, "AMSDU pack count of %d MSDU in TXD: %8d ",
|
|
i + 1, mib->tx_amsdu[i]);
|
|
if (mib->tx_amsdu_cnt)
|
|
seq_printf(file, "(%3d%%)\n",
|
|
mib->tx_amsdu[i] * 100 / mib->tx_amsdu_cnt);
|
|
else
|
|
seq_puts(file, "\n");
|
|
}
|
|
|
|
mt7921_mutex_release(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
DEFINE_SHOW_ATTRIBUTE(mt7921_tx_stats);
|
|
|
|
static int
|
|
mt7921_queues_acq(struct seq_file *s, void *data)
|
|
{
|
|
struct mt7921_dev *dev = dev_get_drvdata(s->private);
|
|
int i;
|
|
|
|
mt7921_mutex_acquire(dev);
|
|
|
|
for (i = 0; i < 4; i++) {
|
|
u32 ctrl, val, qlen = 0;
|
|
int j;
|
|
|
|
val = mt76_rr(dev, MT_PLE_AC_QEMPTY(i));
|
|
ctrl = BIT(31) | BIT(11) | (i << 24);
|
|
|
|
for (j = 0; j < 32; j++) {
|
|
if (val & BIT(j))
|
|
continue;
|
|
|
|
mt76_wr(dev, MT_PLE_FL_Q0_CTRL, ctrl | j);
|
|
qlen += mt76_get_field(dev, MT_PLE_FL_Q3_CTRL,
|
|
GENMASK(11, 0));
|
|
}
|
|
seq_printf(s, "AC%d: queued=%d\n", i, qlen);
|
|
}
|
|
|
|
mt7921_mutex_release(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_queues_read(struct seq_file *s, void *data)
|
|
{
|
|
struct mt7921_dev *dev = dev_get_drvdata(s->private);
|
|
struct {
|
|
struct mt76_queue *q;
|
|
char *queue;
|
|
} queue_map[] = {
|
|
{ dev->mphy.q_tx[MT_TXQ_BE], "WFDMA0" },
|
|
{ dev->mt76.q_mcu[MT_MCUQ_WM], "MCUWM" },
|
|
{ dev->mt76.q_mcu[MT_MCUQ_FWDL], "MCUFWQ" },
|
|
};
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(queue_map); i++) {
|
|
struct mt76_queue *q = queue_map[i].q;
|
|
|
|
if (!q)
|
|
continue;
|
|
|
|
seq_printf(s,
|
|
"%s: queued=%d head=%d tail=%d\n",
|
|
queue_map[i].queue, q->queued, q->head,
|
|
q->tail);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
mt7921_seq_puts_array(struct seq_file *file, const char *str,
|
|
s8 *val, int len)
|
|
{
|
|
int i;
|
|
|
|
seq_printf(file, "%-16s:", str);
|
|
for (i = 0; i < len; i++)
|
|
if (val[i] == 127)
|
|
seq_printf(file, " %6s", "N.A");
|
|
else
|
|
seq_printf(file, " %6d", val[i]);
|
|
seq_puts(file, "\n");
|
|
}
|
|
|
|
#define mt7921_print_txpwr_entry(prefix, rate) \
|
|
({ \
|
|
mt7921_seq_puts_array(s, #prefix " (user)", \
|
|
txpwr.data[TXPWR_USER].rate, \
|
|
ARRAY_SIZE(txpwr.data[TXPWR_USER].rate)); \
|
|
mt7921_seq_puts_array(s, #prefix " (eeprom)", \
|
|
txpwr.data[TXPWR_EEPROM].rate, \
|
|
ARRAY_SIZE(txpwr.data[TXPWR_EEPROM].rate)); \
|
|
mt7921_seq_puts_array(s, #prefix " (tmac)", \
|
|
txpwr.data[TXPWR_MAC].rate, \
|
|
ARRAY_SIZE(txpwr.data[TXPWR_MAC].rate)); \
|
|
})
|
|
|
|
static int
|
|
mt7921_txpwr(struct seq_file *s, void *data)
|
|
{
|
|
struct mt7921_dev *dev = dev_get_drvdata(s->private);
|
|
struct mt7921_txpwr txpwr;
|
|
int ret;
|
|
|
|
mt7921_mutex_acquire(dev);
|
|
ret = mt7921_get_txpwr_info(dev, &txpwr);
|
|
mt7921_mutex_release(dev);
|
|
|
|
if (ret)
|
|
return ret;
|
|
|
|
seq_printf(s, "Tx power table (channel %d)\n", txpwr.ch);
|
|
seq_printf(s, "%-16s %6s %6s %6s %6s\n",
|
|
" ", "1m", "2m", "5m", "11m");
|
|
mt7921_print_txpwr_entry(CCK, cck);
|
|
|
|
seq_printf(s, "%-16s %6s %6s %6s %6s %6s %6s %6s %6s\n",
|
|
" ", "6m", "9m", "12m", "18m", "24m", "36m",
|
|
"48m", "54m");
|
|
mt7921_print_txpwr_entry(OFDM, ofdm);
|
|
|
|
seq_printf(s, "%-16s %6s %6s %6s %6s %6s %6s %6s %6s\n",
|
|
" ", "mcs0", "mcs1", "mcs2", "mcs3", "mcs4", "mcs5",
|
|
"mcs6", "mcs7");
|
|
mt7921_print_txpwr_entry(HT20, ht20);
|
|
|
|
seq_printf(s, "%-16s %6s %6s %6s %6s %6s %6s %6s %6s %6s\n",
|
|
" ", "mcs0", "mcs1", "mcs2", "mcs3", "mcs4", "mcs5",
|
|
"mcs6", "mcs7", "mcs32");
|
|
mt7921_print_txpwr_entry(HT40, ht40);
|
|
|
|
seq_printf(s, "%-16s %6s %6s %6s %6s %6s %6s %6s %6s %6s %6s %6s %6s\n",
|
|
" ", "mcs0", "mcs1", "mcs2", "mcs3", "mcs4", "mcs5",
|
|
"mcs6", "mcs7", "mcs8", "mcs9", "mcs10", "mcs11");
|
|
mt7921_print_txpwr_entry(VHT20, vht20);
|
|
mt7921_print_txpwr_entry(VHT40, vht40);
|
|
mt7921_print_txpwr_entry(VHT80, vht80);
|
|
mt7921_print_txpwr_entry(VHT160, vht160);
|
|
mt7921_print_txpwr_entry(HE26, he26);
|
|
mt7921_print_txpwr_entry(HE52, he52);
|
|
mt7921_print_txpwr_entry(HE106, he106);
|
|
mt7921_print_txpwr_entry(HE242, he242);
|
|
mt7921_print_txpwr_entry(HE484, he484);
|
|
mt7921_print_txpwr_entry(HE996, he996);
|
|
mt7921_print_txpwr_entry(HE996x2, he996x2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_pm_set(void *data, u64 val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
struct mt76_connac_pm *pm = &dev->pm;
|
|
|
|
if (mt76_is_usb(&dev->mt76))
|
|
return -EOPNOTSUPP;
|
|
|
|
mutex_lock(&dev->mt76.mutex);
|
|
|
|
if (val == pm->enable_user)
|
|
goto out;
|
|
|
|
if (!pm->enable_user) {
|
|
pm->stats.last_wake_event = jiffies;
|
|
pm->stats.last_doze_event = jiffies;
|
|
}
|
|
/* make sure the chip is awake here and ps_work is scheduled
|
|
* just at end of the this routine.
|
|
*/
|
|
pm->enable = false;
|
|
mt76_connac_pm_wake(&dev->mphy, pm);
|
|
|
|
pm->enable_user = val;
|
|
mt7921_set_runtime_pm(dev);
|
|
mt76_connac_power_save_sched(&dev->mphy, pm);
|
|
out:
|
|
mutex_unlock(&dev->mt76.mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_pm_get(void *data, u64 *val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
*val = dev->pm.enable_user;
|
|
|
|
return 0;
|
|
}
|
|
|
|
DEFINE_DEBUGFS_ATTRIBUTE(fops_pm, mt7921_pm_get, mt7921_pm_set, "%lld\n");
|
|
|
|
static int
|
|
mt7921_deep_sleep_set(void *data, u64 val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
struct mt76_connac_pm *pm = &dev->pm;
|
|
bool monitor = !!(dev->mphy.hw->conf.flags & IEEE80211_CONF_MONITOR);
|
|
bool enable = !!val;
|
|
|
|
if (mt76_is_usb(&dev->mt76))
|
|
return -EOPNOTSUPP;
|
|
|
|
mt7921_mutex_acquire(dev);
|
|
if (pm->ds_enable_user == enable)
|
|
goto out;
|
|
|
|
pm->ds_enable_user = enable;
|
|
pm->ds_enable = enable && !monitor;
|
|
mt76_connac_mcu_set_deep_sleep(&dev->mt76, pm->ds_enable);
|
|
out:
|
|
mt7921_mutex_release(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_deep_sleep_get(void *data, u64 *val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
*val = dev->pm.ds_enable_user;
|
|
|
|
return 0;
|
|
}
|
|
|
|
DEFINE_DEBUGFS_ATTRIBUTE(fops_ds, mt7921_deep_sleep_get,
|
|
mt7921_deep_sleep_set, "%lld\n");
|
|
|
|
static int
|
|
mt7921_pm_stats(struct seq_file *s, void *data)
|
|
{
|
|
struct mt7921_dev *dev = dev_get_drvdata(s->private);
|
|
struct mt76_connac_pm *pm = &dev->pm;
|
|
|
|
unsigned long awake_time = pm->stats.awake_time;
|
|
unsigned long doze_time = pm->stats.doze_time;
|
|
|
|
if (!test_bit(MT76_STATE_PM, &dev->mphy.state))
|
|
awake_time += jiffies - pm->stats.last_wake_event;
|
|
else
|
|
doze_time += jiffies - pm->stats.last_doze_event;
|
|
|
|
seq_printf(s, "awake time: %14u\ndoze time: %15u\n",
|
|
jiffies_to_msecs(awake_time),
|
|
jiffies_to_msecs(doze_time));
|
|
|
|
seq_printf(s, "low power wakes: %9d\n", pm->stats.lp_wake);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_pm_idle_timeout_set(void *data, u64 val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
dev->pm.idle_timeout = msecs_to_jiffies(val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
mt7921_pm_idle_timeout_get(void *data, u64 *val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
|
|
*val = jiffies_to_msecs(dev->pm.idle_timeout);
|
|
|
|
return 0;
|
|
}
|
|
|
|
DEFINE_DEBUGFS_ATTRIBUTE(fops_pm_idle_timeout, mt7921_pm_idle_timeout_get,
|
|
mt7921_pm_idle_timeout_set, "%lld\n");
|
|
|
|
static int mt7921_chip_reset(void *data, u64 val)
|
|
{
|
|
struct mt7921_dev *dev = data;
|
|
int ret = 0;
|
|
|
|
switch (val) {
|
|
case 1:
|
|
/* Reset wifisys directly. */
|
|
mt7921_reset(&dev->mt76);
|
|
break;
|
|
default:
|
|
/* Collect the core dump before reset wifisys. */
|
|
mt7921_mutex_acquire(dev);
|
|
ret = mt76_connac_mcu_chip_config(&dev->mt76);
|
|
mt7921_mutex_release(dev);
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
DEFINE_DEBUGFS_ATTRIBUTE(fops_reset, NULL, mt7921_chip_reset, "%lld\n");
|
|
|
|
static int
|
|
mt7921s_sched_quota_read(struct seq_file *s, void *data)
|
|
{
|
|
struct mt7921_dev *dev = dev_get_drvdata(s->private);
|
|
struct mt76_sdio *sdio = &dev->mt76.sdio;
|
|
|
|
seq_printf(s, "pse_data_quota\t%d\n", sdio->sched.pse_data_quota);
|
|
seq_printf(s, "ple_data_quota\t%d\n", sdio->sched.ple_data_quota);
|
|
seq_printf(s, "pse_mcu_quota\t%d\n", sdio->sched.pse_mcu_quota);
|
|
seq_printf(s, "sched_deficit\t%d\n", sdio->sched.deficit);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mt7921_init_debugfs(struct mt7921_dev *dev)
|
|
{
|
|
struct dentry *dir;
|
|
|
|
dir = mt76_register_debugfs_fops(&dev->mphy, &fops_regval);
|
|
if (!dir)
|
|
return -ENOMEM;
|
|
|
|
if (mt76_is_mmio(&dev->mt76))
|
|
debugfs_create_devm_seqfile(dev->mt76.dev, "xmit-queues",
|
|
dir, mt7921_queues_read);
|
|
else
|
|
debugfs_create_devm_seqfile(dev->mt76.dev, "xmit-queues",
|
|
dir, mt76_queues_read);
|
|
|
|
debugfs_create_devm_seqfile(dev->mt76.dev, "acq", dir,
|
|
mt7921_queues_acq);
|
|
debugfs_create_devm_seqfile(dev->mt76.dev, "txpower_sku", dir,
|
|
mt7921_txpwr);
|
|
debugfs_create_file("tx_stats", 0400, dir, dev, &mt7921_tx_stats_fops);
|
|
debugfs_create_file("fw_debug", 0600, dir, dev, &fops_fw_debug);
|
|
debugfs_create_file("runtime-pm", 0600, dir, dev, &fops_pm);
|
|
debugfs_create_file("idle-timeout", 0600, dir, dev,
|
|
&fops_pm_idle_timeout);
|
|
debugfs_create_file("chip_reset", 0600, dir, dev, &fops_reset);
|
|
debugfs_create_devm_seqfile(dev->mt76.dev, "runtime_pm_stats", dir,
|
|
mt7921_pm_stats);
|
|
debugfs_create_file("deep-sleep", 0600, dir, dev, &fops_ds);
|
|
if (mt76_is_sdio(&dev->mt76))
|
|
debugfs_create_devm_seqfile(dev->mt76.dev, "sched-quota", dir,
|
|
mt7921s_sched_quota_read);
|
|
return 0;
|
|
}
|