207 lines · 5.6 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0-only/* * Intel SOC Punit device state debug driver * Punit controls power management for North Complex devices (Graphics * blocks, Image Signal Processing, video processing, display, DSP etc.) * * Copyright (c) 2015, Intel Corporation. */ #define pr_fmt(fmt) "punit_atom: " fmt #include <linux/acpi.h>#include <linux/module.h>#include <linux/init.h>#include <linux/device.h>#include <linux/debugfs.h>#include <linux/seq_file.h>#include <linux/io.h>#include <asm/cpu_device_id.h>#include <asm/intel-family.h>#include <asm/iosf_mbi.h> /* Subsystem config/status Video processor */#define VED_SS_PM0		0x32/* Subsystem config/status ISP (Image Signal Processor) */#define ISP_SS_PM0		0x39/* Subsystem config/status Input/output controller */#define MIO_SS_PM		0x3B/* Shift bits for getting status for video, isp and i/o */#define SSS_SHIFT		24 /* Power gate status reg */#define PWRGT_STATUS		0x61/* Shift bits for getting status for graphics rendering */#define RENDER_POS		0/* Shift bits for getting status for media control */#define MEDIA_POS		2/* Shift bits for getting status for Valley View/Baytrail display */#define VLV_DISPLAY_POS		6 /* Subsystem config/status display for Cherry Trail SOC */#define CHT_DSP_SSS		0x36/* Shift bits for getting status for display */#define CHT_DSP_SSS_POS		16 struct punit_device {	char *name;	int reg;	int sss_pos;}; static const struct punit_device punit_device_tng[] = {	{ "DISPLAY",	CHT_DSP_SSS,	SSS_SHIFT },	{ "VED",	VED_SS_PM0,	SSS_SHIFT },	{ "ISP",	ISP_SS_PM0,	SSS_SHIFT },	{ "MIO",	MIO_SS_PM,	SSS_SHIFT },	{ NULL }}; static const struct punit_device punit_device_byt[] = {	{ "GFX RENDER",	PWRGT_STATUS,	RENDER_POS },	{ "GFX MEDIA",	PWRGT_STATUS,	MEDIA_POS },	{ "DISPLAY",	PWRGT_STATUS,	VLV_DISPLAY_POS },	{ "VED",	VED_SS_PM0,	SSS_SHIFT },	{ "ISP",	ISP_SS_PM0,	SSS_SHIFT },	{ "MIO",	MIO_SS_PM,	SSS_SHIFT },	{ NULL }}; static const struct punit_device punit_device_cht[] = {	{ "GFX RENDER",	PWRGT_STATUS,	RENDER_POS },	{ "GFX MEDIA",	PWRGT_STATUS,	MEDIA_POS },	{ "DISPLAY",	CHT_DSP_SSS,	CHT_DSP_SSS_POS },	{ "VED",	VED_SS_PM0,	SSS_SHIFT },	{ "ISP",	ISP_SS_PM0,	SSS_SHIFT },	{ "MIO",	MIO_SS_PM,	SSS_SHIFT },	{ NULL }}; static const char * const dstates[] = {"D0", "D0i1", "D0i2", "D0i3"}; static int punit_dev_state_show(struct seq_file *seq_file, void *unused){	u32 punit_pwr_status;	struct punit_device *punit_devp = seq_file->private;	int index;	int status; 	seq_puts(seq_file, "\n\nPUNIT NORTH COMPLEX DEVICES :\n");	while (punit_devp->name) {		status = iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ,				       punit_devp->reg, &punit_pwr_status);		if (status) {			seq_printf(seq_file, "%9s : Read Failed\n",				   punit_devp->name);		} else  {			index = (punit_pwr_status >> punit_devp->sss_pos) & 3;			seq_printf(seq_file, "%9s : %s\n", punit_devp->name,				   dstates[index]);		}		punit_devp++;	} 	return 0;}DEFINE_SHOW_ATTRIBUTE(punit_dev_state); static struct dentry *punit_dbg_file; static void punit_dbgfs_register(struct punit_device *punit_device){	punit_dbg_file = debugfs_create_dir("punit_atom", NULL); 	debugfs_create_file("dev_power_state", 0444, punit_dbg_file,			    punit_device, &punit_dev_state_fops);} static void punit_dbgfs_unregister(void){	debugfs_remove_recursive(punit_dbg_file);} #if defined(CONFIG_ACPI) && defined(CONFIG_SUSPEND)static const struct punit_device *punit_dev; static void punit_s2idle_check(void){	const struct punit_device *punit_devp;	u32 punit_pwr_status, dstate;	int status; 	for (punit_devp = punit_dev; punit_devp->name; punit_devp++) {		/* Skip MIO, it is on till the very last moment */		if (punit_devp->reg == MIO_SS_PM)			continue; 		status = iosf_mbi_read(BT_MBI_UNIT_PMC, MBI_REG_READ,				       punit_devp->reg, &punit_pwr_status);		if (status) {			pr_err("%s read failed\n", punit_devp->name);		} else  {			dstate = (punit_pwr_status >> punit_devp->sss_pos) & 3;			if (!dstate)				pr_err("%s is in D0 prior to s2idle\n", punit_devp->name);		}	}} static struct acpi_s2idle_dev_ops punit_s2idle_ops = {	.check = punit_s2idle_check,}; static void punit_s2idle_check_register(struct punit_device *punit_device){	punit_dev = punit_device;	acpi_register_lps0_dev(&punit_s2idle_ops);} static void punit_s2idle_check_unregister(void){	acpi_unregister_lps0_dev(&punit_s2idle_ops);}#elsestatic void punit_s2idle_check_register(struct punit_device *punit_device) {}static void punit_s2idle_check_unregister(void) {}#endif #define X86_MATCH(vfm, data)					 \	X86_MATCH_VFM_FEATURE(vfm, X86_FEATURE_MWAIT, data) static const struct x86_cpu_id intel_punit_cpu_ids[] = {	X86_MATCH(INTEL_ATOM_SILVERMONT,	&punit_device_byt),	X86_MATCH(INTEL_ATOM_SILVERMONT_MID,	&punit_device_tng),	X86_MATCH(INTEL_ATOM_AIRMONT,		&punit_device_cht),	{}};MODULE_DEVICE_TABLE(x86cpu, intel_punit_cpu_ids); static int __init punit_atom_debug_init(void){	struct punit_device *punit_device;	const struct x86_cpu_id *id; 	id = x86_match_cpu(intel_punit_cpu_ids);	if (!id)		return -ENODEV; 	punit_device = (struct punit_device *)id->driver_data;	punit_dbgfs_register(punit_device);	punit_s2idle_check_register(punit_device); 	return 0;} static void __exit punit_atom_debug_exit(void){	punit_s2idle_check_unregister();	punit_dbgfs_unregister();} module_init(punit_atom_debug_init);module_exit(punit_atom_debug_exit); MODULE_AUTHOR("Kumar P, Mahesh <mahesh.kumar.p@intel.com>");MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");MODULE_DESCRIPTION("Driver for Punit devices states debugging");MODULE_LICENSE("GPL v2");