arch/x86/platform/atom/pmc_atom.c - kernel/bruno - Git at Google

 /*
  * Intel Atom SOC Power Management Controller Driver
  * Copyright (c) 2014, Intel Corporation.
  *
  * This program is free software; you can redistribute it and/or modify it
  * under the terms and conditions of the GNU General Public License,
  * version 2, as published by the Free Software Foundation.
  *
  * This program is distributed in the hope it will be useful, but WITHOUT
  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  * more details.
  *
  */

 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

 #include <linux/init.h>
 #include <linux/pci.h>
 #include <linux/device.h>
 #include <linux/debugfs.h>
 #include <linux/seq_file.h>
 #include <linux/io.h>

 #include <asm/pmc_atom.h>

 struct pmc_bit_map {
 	const char *name;
 	u32 bit_mask;
 };

 struct pmc_reg_map {
 	const struct pmc_bit_map *d3_sts_0;
 	const struct pmc_bit_map *d3_sts_1;
 	const struct pmc_bit_map *func_dis;
 	const struct pmc_bit_map *func_dis_2;
 	const struct pmc_bit_map *pss;
 };

 struct pmc_dev {
 	u32 base_addr;
 	void __iomem *regmap;
 	const struct pmc_reg_map *map;
 #ifdef CONFIG_DEBUG_FS
 	struct dentry *dbgfs_dir;
 #endif /* CONFIG_DEBUG_FS */
 	bool init;
 };

 static struct pmc_dev pmc_device;
 static u32 acpi_base_addr;

 static const struct pmc_bit_map d3_sts_0_map[] = {
 	{"LPSS1_F0_DMA",	BIT_LPSS1_F0_DMA},
 	{"LPSS1_F1_PWM1",	BIT_LPSS1_F1_PWM1},
 	{"LPSS1_F2_PWM2",	BIT_LPSS1_F2_PWM2},
 	{"LPSS1_F3_HSUART1",	BIT_LPSS1_F3_HSUART1},
 	{"LPSS1_F4_HSUART2",	BIT_LPSS1_F4_HSUART2},
 	{"LPSS1_F5_SPI",	BIT_LPSS1_F5_SPI},
 	{"LPSS1_F6_Reserved",	BIT_LPSS1_F6_XXX},
 	{"LPSS1_F7_Reserved",	BIT_LPSS1_F7_XXX},
 	{"SCC_EMMC",		BIT_SCC_EMMC},
 	{"SCC_SDIO",		BIT_SCC_SDIO},
 	{"SCC_SDCARD",		BIT_SCC_SDCARD},
 	{"SCC_MIPI",		BIT_SCC_MIPI},
 	{"HDA",			BIT_HDA},
 	{"LPE",			BIT_LPE},
 	{"OTG",			BIT_OTG},
 	{"USH",			BIT_USH},
 	{"GBE",			BIT_GBE},
 	{"SATA",		BIT_SATA},
 	{"USB_EHCI",		BIT_USB_EHCI},
 	{"SEC",			BIT_SEC},
 	{"PCIE_PORT0",		BIT_PCIE_PORT0},
 	{"PCIE_PORT1",		BIT_PCIE_PORT1},
 	{"PCIE_PORT2",		BIT_PCIE_PORT2},
 	{"PCIE_PORT3",		BIT_PCIE_PORT3},
 	{"LPSS2_F0_DMA",	BIT_LPSS2_F0_DMA},
 	{"LPSS2_F1_I2C1",	BIT_LPSS2_F1_I2C1},
 	{"LPSS2_F2_I2C2",	BIT_LPSS2_F2_I2C2},
 	{"LPSS2_F3_I2C3",	BIT_LPSS2_F3_I2C3},
 	{"LPSS2_F3_I2C4",	BIT_LPSS2_F4_I2C4},
 	{"LPSS2_F5_I2C5",	BIT_LPSS2_F5_I2C5},
 	{"LPSS2_F6_I2C6",	BIT_LPSS2_F6_I2C6},
 	{"LPSS2_F7_I2C7",	BIT_LPSS2_F7_I2C7},
 	{},
 };

 static struct pmc_bit_map byt_d3_sts_1_map[] = {
 	{"SMB",			BIT_SMB},
 	{"OTG_SS_PHY",		BIT_OTG_SS_PHY},
 	{"USH_SS_PHY",		BIT_USH_SS_PHY},
 	{"DFX",			BIT_DFX},
 	{},
 };

 static struct pmc_bit_map cht_d3_sts_1_map[] = {
 	{"SMB",			BIT_SMB},
 	{"GMM",			BIT_STS_GMM},
 	{"ISH",			BIT_STS_ISH},
 	{},
 };

 static struct pmc_bit_map cht_func_dis_2_map[] = {
 	{"SMB",			BIT_SMB},
 	{"GMM",			BIT_FD_GMM},
 	{"ISH",			BIT_FD_ISH},
 	{},
 };

 static const struct pmc_bit_map byt_pss_map[] = {
 	{"GBE",			PMC_PSS_BIT_GBE},
 	{"SATA",		PMC_PSS_BIT_SATA},
 	{"HDA",			PMC_PSS_BIT_HDA},
 	{"SEC",			PMC_PSS_BIT_SEC},
 	{"PCIE",		PMC_PSS_BIT_PCIE},
 	{"LPSS",		PMC_PSS_BIT_LPSS},
 	{"LPE",			PMC_PSS_BIT_LPE},
 	{"DFX",			PMC_PSS_BIT_DFX},
 	{"USH_CTRL",		PMC_PSS_BIT_USH_CTRL},
 	{"USH_SUS",		PMC_PSS_BIT_USH_SUS},
 	{"USH_VCCS",		PMC_PSS_BIT_USH_VCCS},
 	{"USH_VCCA",		PMC_PSS_BIT_USH_VCCA},
 	{"OTG_CTRL",		PMC_PSS_BIT_OTG_CTRL},
 	{"OTG_VCCS",		PMC_PSS_BIT_OTG_VCCS},
 	{"OTG_VCCA_CLK",	PMC_PSS_BIT_OTG_VCCA_CLK},
 	{"OTG_VCCA",		PMC_PSS_BIT_OTG_VCCA},
 	{"USB",			PMC_PSS_BIT_USB},
 	{"USB_SUS",		PMC_PSS_BIT_USB_SUS},
 	{},
 };

 static const struct pmc_bit_map cht_pss_map[] = {
 	{"SATA",		PMC_PSS_BIT_SATA},
 	{"HDA",			PMC_PSS_BIT_HDA},
 	{"SEC",			PMC_PSS_BIT_SEC},
 	{"PCIE",		PMC_PSS_BIT_PCIE},
 	{"LPSS",		PMC_PSS_BIT_LPSS},
 	{"LPE",			PMC_PSS_BIT_LPE},
 	{"UFS",			PMC_PSS_BIT_CHT_UFS},
 	{"UXD",			PMC_PSS_BIT_CHT_UXD},
 	{"UXD_FD",		PMC_PSS_BIT_CHT_UXD_FD},
 	{"UX_ENG",		PMC_PSS_BIT_CHT_UX_ENG},
 	{"USB_SUS",		PMC_PSS_BIT_CHT_USB_SUS},
 	{"GMM",			PMC_PSS_BIT_CHT_GMM},
 	{"ISH",			PMC_PSS_BIT_CHT_ISH},
 	{"DFX_MASTER",		PMC_PSS_BIT_CHT_DFX_MASTER},
 	{"DFX_CLUSTER1",	PMC_PSS_BIT_CHT_DFX_CLUSTER1},
 	{"DFX_CLUSTER2",	PMC_PSS_BIT_CHT_DFX_CLUSTER2},
 	{"DFX_CLUSTER3",	PMC_PSS_BIT_CHT_DFX_CLUSTER3},
 	{"DFX_CLUSTER4",	PMC_PSS_BIT_CHT_DFX_CLUSTER4},
 	{"DFX_CLUSTER5",	PMC_PSS_BIT_CHT_DFX_CLUSTER5},
 	{},
 };

 static const struct pmc_reg_map byt_reg_map = {
 	.d3_sts_0	= d3_sts_0_map,
 	.d3_sts_1	= byt_d3_sts_1_map,
 	.func_dis	= d3_sts_0_map,
 	.func_dis_2	= byt_d3_sts_1_map,
 	.pss		= byt_pss_map,
 };

 static const struct pmc_reg_map cht_reg_map = {
 	.d3_sts_0	= d3_sts_0_map,
 	.d3_sts_1	= cht_d3_sts_1_map,
 	.func_dis	= d3_sts_0_map,
 	.func_dis_2	= cht_func_dis_2_map,
 	.pss		= cht_pss_map,
 };

 static inline u32 pmc_reg_read(struct pmc_dev *pmc, int reg_offset)
 {
 	return readl(pmc->regmap + reg_offset);
 }

 static inline void pmc_reg_write(struct pmc_dev *pmc, int reg_offset, u32 val)
 {
 	writel(val, pmc->regmap + reg_offset);
 }

 int pmc_atom_read(int offset, u32 *value)
 {
 	struct pmc_dev *pmc = &pmc_device;

 	if (!pmc->init)
 		return -ENODEV;

 	*value = pmc_reg_read(pmc, offset);
 	return 0;
 }
 EXPORT_SYMBOL_GPL(pmc_atom_read);

 int pmc_atom_write(int offset, u32 value)
 {
 	struct pmc_dev *pmc = &pmc_device;

 	if (!pmc->init)
 		return -ENODEV;

 	pmc_reg_write(pmc, offset, value);
 	return 0;
 }
 EXPORT_SYMBOL_GPL(pmc_atom_write);

 static void pmc_power_off(void)
 {
 	u16	pm1_cnt_port;
 	u32	pm1_cnt_value;

 	pr_info("Preparing to enter system sleep state S5\n");

 	pm1_cnt_port = acpi_base_addr + PM1_CNT;

 	pm1_cnt_value = inl(pm1_cnt_port);
 	pm1_cnt_value &= SLEEP_TYPE_MASK;
 	pm1_cnt_value |= SLEEP_TYPE_S5;
 	pm1_cnt_value |= SLEEP_ENABLE;

 	outl(pm1_cnt_value, pm1_cnt_port);
 }

 static void pmc_hw_reg_setup(struct pmc_dev *pmc)
 {
 	/*
 	 * Disable PMC S0IX_WAKE_EN events coming from:
 	 * - LPC clock run
 	 * - GPIO_SUS ored dedicated IRQs
 	 * - GPIO_SCORE ored dedicated IRQs
 	 * - GPIO_SUS shared IRQ
 	 * - GPIO_SCORE shared IRQ
 	 */
 	pmc_reg_write(pmc, PMC_S0IX_WAKE_EN, (u32)PMC_WAKE_EN_SETTING);
 }

 #ifdef CONFIG_DEBUG_FS
 static void pmc_dev_state_print(struct seq_file *s, int reg_index,
 				u32 sts, const struct pmc_bit_map *sts_map,
 				u32 fd, const struct pmc_bit_map *fd_map)
 {
 	int offset = PMC_REG_BIT_WIDTH * reg_index;
 	int index;

 	for (index = 0; sts_map[index].name; index++) {
 		seq_printf(s, "Dev: %-2d - %-32s\tState: %s [%s]\n",
 			offset + index, sts_map[index].name,
 			fd_map[index].bit_mask & fd ?  "Disabled" : "Enabled ",
 			sts_map[index].bit_mask & sts ?  "D3" : "D0");
 	}
 }

 static int pmc_dev_state_show(struct seq_file *s, void *unused)
 {
 	struct pmc_dev *pmc = s->private;
 	const struct pmc_reg_map *m = pmc->map;
 	u32 func_dis, func_dis_2;
 	u32 d3_sts_0, d3_sts_1;

 	func_dis = pmc_reg_read(pmc, PMC_FUNC_DIS);
 	func_dis_2 = pmc_reg_read(pmc, PMC_FUNC_DIS_2);
 	d3_sts_0 = pmc_reg_read(pmc, PMC_D3_STS_0);
 	d3_sts_1 = pmc_reg_read(pmc, PMC_D3_STS_1);

 	/* Low part */
 	pmc_dev_state_print(s, 0, d3_sts_0, m->d3_sts_0, func_dis, m->func_dis);

 	/* High part */
 	pmc_dev_state_print(s, 1, d3_sts_1, m->d3_sts_1, func_dis_2, m->func_dis_2);

 	return 0;
 }

 static int pmc_dev_state_open(struct inode *inode, struct file *file)
 {
 	return single_open(file, pmc_dev_state_show, inode->i_private);
 }

 static const struct file_operations pmc_dev_state_ops = {
 	.open		= pmc_dev_state_open,
 	.read		= seq_read,
 	.llseek		= seq_lseek,
 	.release	= single_release,
 };

 static int pmc_pss_state_show(struct seq_file *s, void *unused)
 {
 	struct pmc_dev *pmc = s->private;
 	const struct pmc_bit_map *map = pmc->map->pss;
 	u32 pss = pmc_reg_read(pmc, PMC_PSS);
 	int index;

 	for (index = 0; map[index].name; index++) {
 		seq_printf(s, "Island: %-2d - %-32s\tState: %s\n",
 			index, map[index].name,
 			map[index].bit_mask & pss ? "Off" : "On");
 	}
 	return 0;
 }

 static int pmc_pss_state_open(struct inode *inode, struct file *file)
 {
 	return single_open(file, pmc_pss_state_show, inode->i_private);
 }

 static const struct file_operations pmc_pss_state_ops = {
 	.open		= pmc_pss_state_open,
 	.read		= seq_read,
 	.llseek		= seq_lseek,
 	.release	= single_release,
 };

 static int pmc_sleep_tmr_show(struct seq_file *s, void *unused)
 {
 	struct pmc_dev *pmc = s->private;
 	u64 s0ir_tmr, s0i1_tmr, s0i2_tmr, s0i3_tmr, s0_tmr;

 	s0ir_tmr = (u64)pmc_reg_read(pmc, PMC_S0IR_TMR) << PMC_TMR_SHIFT;
 	s0i1_tmr = (u64)pmc_reg_read(pmc, PMC_S0I1_TMR) << PMC_TMR_SHIFT;
 	s0i2_tmr = (u64)pmc_reg_read(pmc, PMC_S0I2_TMR) << PMC_TMR_SHIFT;
 	s0i3_tmr = (u64)pmc_reg_read(pmc, PMC_S0I3_TMR) << PMC_TMR_SHIFT;
 	s0_tmr = (u64)pmc_reg_read(pmc, PMC_S0_TMR) << PMC_TMR_SHIFT;

 	seq_printf(s, "S0IR Residency:\t%lldus\n", s0ir_tmr);
 	seq_printf(s, "S0I1 Residency:\t%lldus\n", s0i1_tmr);
 	seq_printf(s, "S0I2 Residency:\t%lldus\n", s0i2_tmr);
 	seq_printf(s, "S0I3 Residency:\t%lldus\n", s0i3_tmr);
 	seq_printf(s, "S0   Residency:\t%lldus\n", s0_tmr);
 	return 0;
 }

 static int pmc_sleep_tmr_open(struct inode *inode, struct file *file)
 {
 	return single_open(file, pmc_sleep_tmr_show, inode->i_private);
 }

 static const struct file_operations pmc_sleep_tmr_ops = {
 	.open		= pmc_sleep_tmr_open,
 	.read		= seq_read,
 	.llseek		= seq_lseek,
 	.release	= single_release,
 };

 static void pmc_dbgfs_unregister(struct pmc_dev *pmc)
 {
 	debugfs_remove_recursive(pmc->dbgfs_dir);
 }

 static int pmc_dbgfs_register(struct pmc_dev *pmc)
 {
 	struct dentry *dir, *f;

 	dir = debugfs_create_dir("pmc_atom", NULL);
 	if (!dir)
 		return -ENOMEM;

 	pmc->dbgfs_dir = dir;

 	f = debugfs_create_file("dev_state", S_IFREG | S_IRUGO,
 				dir, pmc, &pmc_dev_state_ops);
 	if (!f)
 		goto err;

 	f = debugfs_create_file("pss_state", S_IFREG | S_IRUGO,
 				dir, pmc, &pmc_pss_state_ops);
 	if (!f)
 		goto err;

 	f = debugfs_create_file("sleep_state", S_IFREG | S_IRUGO,
 				dir, pmc, &pmc_sleep_tmr_ops);
 	if (!f)
 		goto err;

 	return 0;
 err:
 	pmc_dbgfs_unregister(pmc);
 	return -ENODEV;
 }
 #else
 static int pmc_dbgfs_register(struct pmc_dev *pmc)
 {
 	return 0;
 }
 #endif /* CONFIG_DEBUG_FS */

 static int pmc_setup_dev(struct pci_dev *pdev, const struct pci_device_id *ent)
 {
 	struct pmc_dev *pmc = &pmc_device;
 	const struct pmc_reg_map *map = (struct pmc_reg_map *)ent->driver_data;
 	int ret;

 	/* Obtain ACPI base address */
 	pci_read_config_dword(pdev, ACPI_BASE_ADDR_OFFSET, &acpi_base_addr);
 	acpi_base_addr &= ACPI_BASE_ADDR_MASK;

 	/* Install power off function */
 	if (acpi_base_addr != 0 && pm_power_off == NULL)
 		pm_power_off = pmc_power_off;

 	pci_read_config_dword(pdev, PMC_BASE_ADDR_OFFSET, &pmc->base_addr);
 	pmc->base_addr &= PMC_BASE_ADDR_MASK;

 	pmc->regmap = ioremap_nocache(pmc->base_addr, PMC_MMIO_REG_LEN);
 	if (!pmc->regmap) {
 		dev_err(&pdev->dev, "error: ioremap failed\n");
 		return -ENOMEM;
 	}

 	pmc->map = map;

 	/* PMC hardware registers setup */
 	pmc_hw_reg_setup(pmc);

 	ret = pmc_dbgfs_register(pmc);
 	if (ret)
 		dev_warn(&pdev->dev, "debugfs register failed\n");

 	pmc->init = true;
 	return ret;
 }

 /*
  * Data for PCI driver interface
  *
  * used by pci_match_id() call below.
  */
 static const struct pci_device_id pmc_pci_ids[] = {
 	{ PCI_VDEVICE(INTEL, PCI_DEVICE_ID_VLV_PMC), (kernel_ulong_t)&byt_reg_map },
 	{ PCI_VDEVICE(INTEL, PCI_DEVICE_ID_CHT_PMC), (kernel_ulong_t)&cht_reg_map },
 	{ 0, },
 };

 static int __init pmc_atom_init(void)
 {
 	struct pci_dev *pdev = NULL;
 	const struct pci_device_id *ent;

 	/* We look for our device - PCU PMC
 	 * we assume that there is max. one device.
 	 *
 	 * We can't use plain pci_driver mechanism,
 	 * as the device is really a multiple function device,
 	 * main driver that binds to the pci_device is lpc_ich
 	 * and have to find & bind to the device this way.
 	 */
 	for_each_pci_dev(pdev) {
 		ent = pci_match_id(pmc_pci_ids, pdev);
 		if (ent)
 			return pmc_setup_dev(pdev, ent);
 	}
 	/* Device not found. */
 	return -ENODEV;
 }

 device_initcall(pmc_atom_init);

 /*
 MODULE_AUTHOR("Aubrey Li <aubrey.li@linux.intel.com>");
 MODULE_DESCRIPTION("Intel Atom SOC Power Management Controller Interface");
 MODULE_LICENSE("GPL v2");
 */
	/*
	* Intel Atom SOC Power Management Controller Driver
	* Copyright (c) 2014, Intel Corporation.
	*
	* This program is free software; you can redistribute it and/or modify it
	* under the terms and conditions of the GNU General Public License,
	* version 2, as published by the Free Software Foundation.
	*
	* This program is distributed in the hope it will be useful, but WITHOUT
	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	* more details.
	*
	*/

	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

	#include <linux/init.h>
	#include <linux/pci.h>
	#include <linux/device.h>
	#include <linux/debugfs.h>
	#include <linux/seq_file.h>
	#include <linux/io.h>

	#include <asm/pmc_atom.h>

	struct pmc_bit_map {
	const char *name;
	u32 bit_mask;
	};

	struct pmc_reg_map {
	const struct pmc_bit_map *d3_sts_0;
	const struct pmc_bit_map *d3_sts_1;
	const struct pmc_bit_map *func_dis;
	const struct pmc_bit_map *func_dis_2;
	const struct pmc_bit_map *pss;
	};

	struct pmc_dev {
	u32 base_addr;
	void __iomem *regmap;
	const struct pmc_reg_map *map;
	#ifdef CONFIG_DEBUG_FS
	struct dentry *dbgfs_dir;
	#endif /* CONFIG_DEBUG_FS */
	bool init;
	};

	static struct pmc_dev pmc_device;
	static u32 acpi_base_addr;

	static const struct pmc_bit_map d3_sts_0_map[] = {
	{"LPSS1_F0_DMA", BIT_LPSS1_F0_DMA},
	{"LPSS1_F1_PWM1", BIT_LPSS1_F1_PWM1},
	{"LPSS1_F2_PWM2", BIT_LPSS1_F2_PWM2},
	{"LPSS1_F3_HSUART1", BIT_LPSS1_F3_HSUART1},
	{"LPSS1_F4_HSUART2", BIT_LPSS1_F4_HSUART2},
	{"LPSS1_F5_SPI", BIT_LPSS1_F5_SPI},
	{"LPSS1_F6_Reserved", BIT_LPSS1_F6_XXX},
	{"LPSS1_F7_Reserved", BIT_LPSS1_F7_XXX},
	{"SCC_EMMC", BIT_SCC_EMMC},
	{"SCC_SDIO", BIT_SCC_SDIO},
	{"SCC_SDCARD", BIT_SCC_SDCARD},
	{"SCC_MIPI", BIT_SCC_MIPI},
	{"HDA", BIT_HDA},
	{"LPE", BIT_LPE},
	{"OTG", BIT_OTG},
	{"USH", BIT_USH},
	{"GBE", BIT_GBE},
	{"SATA", BIT_SATA},
	{"USB_EHCI", BIT_USB_EHCI},
	{"SEC", BIT_SEC},
	{"PCIE_PORT0", BIT_PCIE_PORT0},
	{"PCIE_PORT1", BIT_PCIE_PORT1},
	{"PCIE_PORT2", BIT_PCIE_PORT2},
	{"PCIE_PORT3", BIT_PCIE_PORT3},
	{"LPSS2_F0_DMA", BIT_LPSS2_F0_DMA},
	{"LPSS2_F1_I2C1", BIT_LPSS2_F1_I2C1},
	{"LPSS2_F2_I2C2", BIT_LPSS2_F2_I2C2},
	{"LPSS2_F3_I2C3", BIT_LPSS2_F3_I2C3},
	{"LPSS2_F3_I2C4", BIT_LPSS2_F4_I2C4},
	{"LPSS2_F5_I2C5", BIT_LPSS2_F5_I2C5},
	{"LPSS2_F6_I2C6", BIT_LPSS2_F6_I2C6},
	{"LPSS2_F7_I2C7", BIT_LPSS2_F7_I2C7},
	{},
	};

	static struct pmc_bit_map byt_d3_sts_1_map[] = {
	{"SMB", BIT_SMB},
	{"OTG_SS_PHY", BIT_OTG_SS_PHY},
	{"USH_SS_PHY", BIT_USH_SS_PHY},
	{"DFX", BIT_DFX},
	{},
	};

	static struct pmc_bit_map cht_d3_sts_1_map[] = {
	{"SMB", BIT_SMB},
	{"GMM", BIT_STS_GMM},
	{"ISH", BIT_STS_ISH},
	{},
	};

	static struct pmc_bit_map cht_func_dis_2_map[] = {
	{"SMB", BIT_SMB},
	{"GMM", BIT_FD_GMM},
	{"ISH", BIT_FD_ISH},
	{},
	};

	static const struct pmc_bit_map byt_pss_map[] = {
	{"GBE", PMC_PSS_BIT_GBE},
	{"SATA", PMC_PSS_BIT_SATA},
	{"HDA", PMC_PSS_BIT_HDA},
	{"SEC", PMC_PSS_BIT_SEC},
	{"PCIE", PMC_PSS_BIT_PCIE},
	{"LPSS", PMC_PSS_BIT_LPSS},
	{"LPE", PMC_PSS_BIT_LPE},
	{"DFX", PMC_PSS_BIT_DFX},
	{"USH_CTRL", PMC_PSS_BIT_USH_CTRL},
	{"USH_SUS", PMC_PSS_BIT_USH_SUS},
	{"USH_VCCS", PMC_PSS_BIT_USH_VCCS},
	{"USH_VCCA", PMC_PSS_BIT_USH_VCCA},
	{"OTG_CTRL", PMC_PSS_BIT_OTG_CTRL},
	{"OTG_VCCS", PMC_PSS_BIT_OTG_VCCS},
	{"OTG_VCCA_CLK", PMC_PSS_BIT_OTG_VCCA_CLK},
	{"OTG_VCCA", PMC_PSS_BIT_OTG_VCCA},
	{"USB", PMC_PSS_BIT_USB},
	{"USB_SUS", PMC_PSS_BIT_USB_SUS},
	{},
	};

	static const struct pmc_bit_map cht_pss_map[] = {
	{"SATA", PMC_PSS_BIT_SATA},
	{"HDA", PMC_PSS_BIT_HDA},
	{"SEC", PMC_PSS_BIT_SEC},
	{"PCIE", PMC_PSS_BIT_PCIE},
	{"LPSS", PMC_PSS_BIT_LPSS},
	{"LPE", PMC_PSS_BIT_LPE},
	{"UFS", PMC_PSS_BIT_CHT_UFS},
	{"UXD", PMC_PSS_BIT_CHT_UXD},
	{"UXD_FD", PMC_PSS_BIT_CHT_UXD_FD},
	{"UX_ENG", PMC_PSS_BIT_CHT_UX_ENG},
	{"USB_SUS", PMC_PSS_BIT_CHT_USB_SUS},
	{"GMM", PMC_PSS_BIT_CHT_GMM},
	{"ISH", PMC_PSS_BIT_CHT_ISH},
	{"DFX_MASTER", PMC_PSS_BIT_CHT_DFX_MASTER},
	{"DFX_CLUSTER1", PMC_PSS_BIT_CHT_DFX_CLUSTER1},
	{"DFX_CLUSTER2", PMC_PSS_BIT_CHT_DFX_CLUSTER2},
	{"DFX_CLUSTER3", PMC_PSS_BIT_CHT_DFX_CLUSTER3},
	{"DFX_CLUSTER4", PMC_PSS_BIT_CHT_DFX_CLUSTER4},
	{"DFX_CLUSTER5", PMC_PSS_BIT_CHT_DFX_CLUSTER5},
	{},
	};

	static const struct pmc_reg_map byt_reg_map = {
	.d3_sts_0 = d3_sts_0_map,
	.d3_sts_1 = byt_d3_sts_1_map,
	.func_dis = d3_sts_0_map,
	.func_dis_2 = byt_d3_sts_1_map,
	.pss = byt_pss_map,
	};

	static const struct pmc_reg_map cht_reg_map = {
	.d3_sts_0 = d3_sts_0_map,
	.d3_sts_1 = cht_d3_sts_1_map,
	.func_dis = d3_sts_0_map,
	.func_dis_2 = cht_func_dis_2_map,
	.pss = cht_pss_map,
	};

	static inline u32 pmc_reg_read(struct pmc_dev *pmc, int reg_offset)
	{
	return readl(pmc->regmap + reg_offset);
	}

	static inline void pmc_reg_write(struct pmc_dev *pmc, int reg_offset, u32 val)
	{
	writel(val, pmc->regmap + reg_offset);
	}

	int pmc_atom_read(int offset, u32 *value)
	{
	struct pmc_dev *pmc = &pmc_device;

	if (!pmc->init)
	return -ENODEV;

	*value = pmc_reg_read(pmc, offset);
	return 0;
	}
	EXPORT_SYMBOL_GPL(pmc_atom_read);

	int pmc_atom_write(int offset, u32 value)
	{
	struct pmc_dev *pmc = &pmc_device;

	if (!pmc->init)
	return -ENODEV;

	pmc_reg_write(pmc, offset, value);
	return 0;
	}
	EXPORT_SYMBOL_GPL(pmc_atom_write);

	static void pmc_power_off(void)
	{
	u16 pm1_cnt_port;
	u32 pm1_cnt_value;

	pr_info("Preparing to enter system sleep state S5\n");

	pm1_cnt_port = acpi_base_addr + PM1_CNT;

	pm1_cnt_value = inl(pm1_cnt_port);
	pm1_cnt_value &= SLEEP_TYPE_MASK;
	pm1_cnt_value \|= SLEEP_TYPE_S5;
	pm1_cnt_value \|= SLEEP_ENABLE;

	outl(pm1_cnt_value, pm1_cnt_port);
	}

	static void pmc_hw_reg_setup(struct pmc_dev *pmc)
	{
	/*
	* Disable PMC S0IX_WAKE_EN events coming from:
	* - LPC clock run
	* - GPIO_SUS ored dedicated IRQs
	* - GPIO_SCORE ored dedicated IRQs
	* - GPIO_SUS shared IRQ
	* - GPIO_SCORE shared IRQ
	*/
	pmc_reg_write(pmc, PMC_S0IX_WAKE_EN, (u32)PMC_WAKE_EN_SETTING);
	}

	#ifdef CONFIG_DEBUG_FS
	static void pmc_dev_state_print(struct seq_file *s, int reg_index,
	u32 sts, const struct pmc_bit_map *sts_map,
	u32 fd, const struct pmc_bit_map *fd_map)
	{
	int offset = PMC_REG_BIT_WIDTH * reg_index;
	int index;

	for (index = 0; sts_map[index].name; index++) {
	seq_printf(s, "Dev: %-2d - %-32s\tState: %s [%s]\n",
	offset + index, sts_map[index].name,
	fd_map[index].bit_mask & fd ? "Disabled" : "Enabled ",
	sts_map[index].bit_mask & sts ? "D3" : "D0");
	}
	}

	static int pmc_dev_state_show(struct seq_file s, void unused)
	{
	struct pmc_dev *pmc = s->private;
	const struct pmc_reg_map *m = pmc->map;
	u32 func_dis, func_dis_2;
	u32 d3_sts_0, d3_sts_1;

	func_dis = pmc_reg_read(pmc, PMC_FUNC_DIS);
	func_dis_2 = pmc_reg_read(pmc, PMC_FUNC_DIS_2);
	d3_sts_0 = pmc_reg_read(pmc, PMC_D3_STS_0);
	d3_sts_1 = pmc_reg_read(pmc, PMC_D3_STS_1);

	/* Low part */
	pmc_dev_state_print(s, 0, d3_sts_0, m->d3_sts_0, func_dis, m->func_dis);

	/* High part */
	pmc_dev_state_print(s, 1, d3_sts_1, m->d3_sts_1, func_dis_2, m->func_dis_2);

	return 0;
	}

	static int pmc_dev_state_open(struct inode inode, struct file file)
	{
	return single_open(file, pmc_dev_state_show, inode->i_private);
	}

	static const struct file_operations pmc_dev_state_ops = {
	.open = pmc_dev_state_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
	};

	static int pmc_pss_state_show(struct seq_file s, void unused)
	{
	struct pmc_dev *pmc = s->private;
	const struct pmc_bit_map *map = pmc->map->pss;
	u32 pss = pmc_reg_read(pmc, PMC_PSS);
	int index;

	for (index = 0; map[index].name; index++) {
	seq_printf(s, "Island: %-2d - %-32s\tState: %s\n",
	index, map[index].name,
	map[index].bit_mask & pss ? "Off" : "On");
	}
	return 0;
	}

	static int pmc_pss_state_open(struct inode inode, struct file file)
	{
	return single_open(file, pmc_pss_state_show, inode->i_private);
	}

	static const struct file_operations pmc_pss_state_ops = {
	.open = pmc_pss_state_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
	};

	static int pmc_sleep_tmr_show(struct seq_file s, void unused)
	{
	struct pmc_dev *pmc = s->private;
	u64 s0ir_tmr, s0i1_tmr, s0i2_tmr, s0i3_tmr, s0_tmr;

	s0ir_tmr = (u64)pmc_reg_read(pmc, PMC_S0IR_TMR) << PMC_TMR_SHIFT;
	s0i1_tmr = (u64)pmc_reg_read(pmc, PMC_S0I1_TMR) << PMC_TMR_SHIFT;
	s0i2_tmr = (u64)pmc_reg_read(pmc, PMC_S0I2_TMR) << PMC_TMR_SHIFT;
	s0i3_tmr = (u64)pmc_reg_read(pmc, PMC_S0I3_TMR) << PMC_TMR_SHIFT;
	s0_tmr = (u64)pmc_reg_read(pmc, PMC_S0_TMR) << PMC_TMR_SHIFT;

	seq_printf(s, "S0IR Residency:\t%lldus\n", s0ir_tmr);
	seq_printf(s, "S0I1 Residency:\t%lldus\n", s0i1_tmr);
	seq_printf(s, "S0I2 Residency:\t%lldus\n", s0i2_tmr);
	seq_printf(s, "S0I3 Residency:\t%lldus\n", s0i3_tmr);
	seq_printf(s, "S0 Residency:\t%lldus\n", s0_tmr);
	return 0;
	}

	static int pmc_sleep_tmr_open(struct inode inode, struct file file)
	{
	return single_open(file, pmc_sleep_tmr_show, inode->i_private);
	}

	static const struct file_operations pmc_sleep_tmr_ops = {
	.open = pmc_sleep_tmr_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
	};

	static void pmc_dbgfs_unregister(struct pmc_dev *pmc)
	{
	debugfs_remove_recursive(pmc->dbgfs_dir);
	}

	static int pmc_dbgfs_register(struct pmc_dev *pmc)
	{
	struct dentry dir, f;

	dir = debugfs_create_dir("pmc_atom", NULL);
	if (!dir)
	return -ENOMEM;

	pmc->dbgfs_dir = dir;

	f = debugfs_create_file("dev_state", S_IFREG \| S_IRUGO,
	dir, pmc, &pmc_dev_state_ops);
	if (!f)
	goto err;

	f = debugfs_create_file("pss_state", S_IFREG \| S_IRUGO,
	dir, pmc, &pmc_pss_state_ops);
	if (!f)
	goto err;

	f = debugfs_create_file("sleep_state", S_IFREG \| S_IRUGO,
	dir, pmc, &pmc_sleep_tmr_ops);
	if (!f)
	goto err;

	return 0;
	err:
	pmc_dbgfs_unregister(pmc);
	return -ENODEV;
	}
	#else
	static int pmc_dbgfs_register(struct pmc_dev *pmc)
	{
	return 0;
	}
	#endif /* CONFIG_DEBUG_FS */

	static int pmc_setup_dev(struct pci_dev pdev, const struct pci_device_id ent)
	{
	struct pmc_dev *pmc = &pmc_device;
	const struct pmc_reg_map map = (struct pmc_reg_map )ent->driver_data;
	int ret;

	/* Obtain ACPI base address */
	pci_read_config_dword(pdev, ACPI_BASE_ADDR_OFFSET, &acpi_base_addr);
	acpi_base_addr &= ACPI_BASE_ADDR_MASK;

	/* Install power off function */
	if (acpi_base_addr != 0 && pm_power_off == NULL)
	pm_power_off = pmc_power_off;

	pci_read_config_dword(pdev, PMC_BASE_ADDR_OFFSET, &pmc->base_addr);
	pmc->base_addr &= PMC_BASE_ADDR_MASK;

	pmc->regmap = ioremap_nocache(pmc->base_addr, PMC_MMIO_REG_LEN);
	if (!pmc->regmap) {
	dev_err(&pdev->dev, "error: ioremap failed\n");
	return -ENOMEM;
	}

	pmc->map = map;

	/* PMC hardware registers setup */
	pmc_hw_reg_setup(pmc);

	ret = pmc_dbgfs_register(pmc);
	if (ret)
	dev_warn(&pdev->dev, "debugfs register failed\n");

	pmc->init = true;
	return ret;
	}

	/*
	* Data for PCI driver interface
	*
	* used by pci_match_id() call below.
	*/
	static const struct pci_device_id pmc_pci_ids[] = {
	{ PCI_VDEVICE(INTEL, PCI_DEVICE_ID_VLV_PMC), (kernel_ulong_t)&byt_reg_map },
	{ PCI_VDEVICE(INTEL, PCI_DEVICE_ID_CHT_PMC), (kernel_ulong_t)&cht_reg_map },
	{ 0, },
	};

	static int __init pmc_atom_init(void)
	{
	struct pci_dev *pdev = NULL;
	const struct pci_device_id *ent;

	/* We look for our device - PCU PMC
	* we assume that there is max. one device.
	*
	* We can't use plain pci_driver mechanism,
	* as the device is really a multiple function device,
	* main driver that binds to the pci_device is lpc_ich
	* and have to find & bind to the device this way.
	*/
	for_each_pci_dev(pdev) {
	ent = pci_match_id(pmc_pci_ids, pdev);
	if (ent)
	return pmc_setup_dev(pdev, ent);
	}
	/* Device not found. */
	return -ENODEV;
	}

	device_initcall(pmc_atom_init);

	/*
	MODULE_AUTHOR("Aubrey Li <aubrey.li@linux.intel.com>");
	MODULE_DESCRIPTION("Intel Atom SOC Power Management Controller Interface");
	MODULE_LICENSE("GPL v2");
	*/