148 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2// Copyright(c) 2023 Intel Corporation3 4#include <linux/acpi.h>5#include <linux/debugfs.h>6#include <linux/delay.h>7#include <linux/device.h>8#include <linux/io.h>9#include <linux/pm_runtime.h>10#include <linux/soundwire/sdw.h>11#include <linux/soundwire/sdw_intel.h>12#include <linux/soundwire/sdw_registers.h>13#include "bus.h"14#include "cadence_master.h"15#include "intel.h"16 17/*18 * debugfs19 */20#ifdef CONFIG_DEBUG_FS21 22#define RD_BUF (2 * PAGE_SIZE)23 24static ssize_t intel_sprintf(void __iomem *mem, bool l,25 char *buf, size_t pos, unsigned int reg)26{27 int value;28 29 if (l)30 value = intel_readl(mem, reg);31 else32 value = intel_readw(mem, reg);33 34 return scnprintf(buf + pos, RD_BUF - pos, "%4x\t%4x\n", reg, value);35}36 37static int intel_reg_show(struct seq_file *s_file, void *data)38{39 struct sdw_intel *sdw = s_file->private;40 void __iomem *s = sdw->link_res->shim;41 void __iomem *vs_s = sdw->link_res->shim_vs;42 ssize_t ret;43 u32 pcm_cap;44 int pcm_bd;45 char *buf;46 int j;47 48 buf = kzalloc(RD_BUF, GFP_KERNEL);49 if (!buf)50 return -ENOMEM;51 52 ret = scnprintf(buf, RD_BUF, "Register Value\n");53 ret += scnprintf(buf + ret, RD_BUF - ret, "\nShim\n");54 55 ret += intel_sprintf(s, true, buf, ret, SDW_SHIM2_LECAP);56 ret += intel_sprintf(s, false, buf, ret, SDW_SHIM2_PCMSCAP);57 58 pcm_cap = intel_readw(s, SDW_SHIM2_PCMSCAP);59 pcm_bd = FIELD_GET(SDW_SHIM2_PCMSCAP_BSS, pcm_cap);60 61 for (j = 0; j < pcm_bd; j++) {62 ret += intel_sprintf(s, false, buf, ret,63 SDW_SHIM2_PCMSYCHM(j));64 ret += intel_sprintf(s, false, buf, ret,65 SDW_SHIM2_PCMSYCHC(j));66 }67 68 ret += scnprintf(buf + ret, RD_BUF - ret, "\nVS CLK controls\n");69 ret += intel_sprintf(vs_s, true, buf, ret, SDW_SHIM2_INTEL_VS_LVSCTL);70 71 ret += scnprintf(buf + ret, RD_BUF - ret, "\nVS Wake registers\n");72 ret += intel_sprintf(vs_s, false, buf, ret, SDW_SHIM2_INTEL_VS_WAKEEN);73 ret += intel_sprintf(vs_s, false, buf, ret, SDW_SHIM2_INTEL_VS_WAKESTS);74 75 ret += scnprintf(buf + ret, RD_BUF - ret, "\nVS IOCTL, ACTMCTL\n");76 ret += intel_sprintf(vs_s, false, buf, ret, SDW_SHIM2_INTEL_VS_IOCTL);77 ret += intel_sprintf(vs_s, false, buf, ret, SDW_SHIM2_INTEL_VS_ACTMCTL);78 79 seq_printf(s_file, "%s", buf);80 kfree(buf);81 82 return 0;83}84DEFINE_SHOW_ATTRIBUTE(intel_reg);85 86static int intel_set_m_datamode(void *data, u64 value)87{88 struct sdw_intel *sdw = data;89 struct sdw_bus *bus = &sdw->cdns.bus;90 91 if (value > SDW_PORT_DATA_MODE_STATIC_1)92 return -EINVAL;93 94 /* Userspace changed the hardware state behind the kernel's back */95 add_taint(TAINT_USER, LOCKDEP_STILL_OK);96 97 bus->params.m_data_mode = value;98 99 return 0;100}101DEFINE_DEBUGFS_ATTRIBUTE(intel_set_m_datamode_fops, NULL,102 intel_set_m_datamode, "%llu\n");103 104static int intel_set_s_datamode(void *data, u64 value)105{106 struct sdw_intel *sdw = data;107 struct sdw_bus *bus = &sdw->cdns.bus;108 109 if (value > SDW_PORT_DATA_MODE_STATIC_1)110 return -EINVAL;111 112 /* Userspace changed the hardware state behind the kernel's back */113 add_taint(TAINT_USER, LOCKDEP_STILL_OK);114 115 bus->params.s_data_mode = value;116 117 return 0;118}119DEFINE_DEBUGFS_ATTRIBUTE(intel_set_s_datamode_fops, NULL,120 intel_set_s_datamode, "%llu\n");121 122void intel_ace2x_debugfs_init(struct sdw_intel *sdw)123{124 struct dentry *root = sdw->cdns.bus.debugfs;125 126 if (!root)127 return;128 129 sdw->debugfs = debugfs_create_dir("intel-sdw", root);130 131 debugfs_create_file("intel-registers", 0400, sdw->debugfs, sdw,132 &intel_reg_fops);133 134 debugfs_create_file("intel-m-datamode", 0200, sdw->debugfs, sdw,135 &intel_set_m_datamode_fops);136 137 debugfs_create_file("intel-s-datamode", 0200, sdw->debugfs, sdw,138 &intel_set_s_datamode_fops);139 140 sdw_cdns_debugfs_init(&sdw->cdns, sdw->debugfs);141}142 143void intel_ace2x_debugfs_exit(struct sdw_intel *sdw)144{145 debugfs_remove_recursive(sdw->debugfs);146}147#endif /* CONFIG_DEBUG_FS */148