cregit-Linux how code gets into the kernel

Release 4.16 drivers/platform/x86/pmc_atom.c

/*
 * 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/debugfs.h>
#include <linux/device.h>
#include <linux/init.h>
#include <linux/io.h>
#include <linux/platform_data/x86/clk-pmc-atom.h>
#include <linux/platform_data/x86/pmc_atom.h>
#include <linux/platform_device.h>
#include <linux/pci.h>
#include <linux/seq_file.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_data {
	
const struct pmc_reg_map *map;
	
const struct pmc_clk *clks;
};


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_clk byt_clks[] = {
	{
		.name = "xtal",
		.freq = 25000000,
		.parent_name = NULL,
        },
	{
		.name = "pll",
		.freq = 19200000,
		.parent_name = "xtal",
        },
	{},
};


static const struct pmc_clk cht_clks[] = {
	{
		.name = "xtal",
		.freq = 19200000,
		.parent_name = NULL,
        },
	{},
};


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 const struct pmc_data byt_data = {
	.map = &byt_reg_map,
	.clks = byt_clks,
};


static const struct pmc_data cht_data = {
	.map = &cht_reg_map,
	.clks = cht_clks,
};


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

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li25100.00%1100.00%
Total25100.00%1100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li29100.00%1100.00%
Total29100.00%1100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
Andy Shevchenko44100.00%1100.00%
Total44100.00%1100.00%

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; }

Contributors

PersonTokensPropCommitsCommitProp
Andy Shevchenko42100.00%1100.00%
Total42100.00%1100.00%

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); }

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li51100.00%1100.00%
Total51100.00%1100.00%


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); }

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li24100.00%1100.00%
Total24100.00%1100.00%

#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"); } }

Contributors

PersonTokensPropCommitsCommitProp
Andy Shevchenko104100.00%1100.00%
Total104100.00%1100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li8468.29%350.00%
Andy Shevchenko3931.71%350.00%
Total123100.00%6100.00%

DEFINE_SHOW_ATTRIBUTE(pmc_dev_state);
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; }

Contributors

PersonTokensPropCommitsCommitProp
Andy Shevchenko99100.00%3100.00%
Total99100.00%3100.00%

DEFINE_SHOW_ATTRIBUTE(pmc_pss_state);
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; }

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li13890.20%150.00%
Dan Carpenter159.80%150.00%
Total153100.00%2100.00%

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

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li18100.00%1100.00%
Total18100.00%1100.00%


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_fops); if (!f) goto err; f = debugfs_create_file("pss_state", S_IFREG | S_IRUGO, dir, pmc, &pmc_pss_state_fops); if (!f) goto err; f = debugfs_create_file("sleep_state", S_IFREG | S_IRUGO, dir, pmc, &pmc_sleep_tmr_fops); if (!f) goto err; return 0; err: pmc_dbgfs_unregister(pmc); return -ENODEV; }

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li10174.81%125.00%
Andy Shevchenko3425.19%375.00%
Total135100.00%4100.00%

#else
static int pmc_dbgfs_register(struct pmc_dev *pmc) { return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Martin Kelly14100.00%1100.00%
Total14100.00%1100.00%

#endif /* CONFIG_DEBUG_FS */
static int pmc_setup_clks(struct pci_dev *pdev, void __iomem *pmc_regmap, const struct pmc_data *pmc_data) { struct platform_device *clkdev; struct pmc_clk_data *clk_data; clk_data = kzalloc(sizeof(*clk_data), GFP_KERNEL); if (!clk_data) return -ENOMEM; clk_data->base = pmc_regmap; /* offset is added by client */ clk_data->clks = pmc_data->clks; clkdev = platform_device_register_data(&pdev->dev, "clk-pmc-atom", PLATFORM_DEVID_NONE, clk_data, sizeof(*clk_data)); if (IS_ERR(clkdev)) { kfree(clk_data); return PTR_ERR(clkdev); } kfree(clk_data); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Irina Tirdea119100.00%1100.00%
Total119100.00%1100.00%


static int pmc_setup_dev(struct pci_dev *pdev, const struct pci_device_id *ent) { struct pmc_dev *pmc = &pmc_device; const struct pmc_data *data = (struct pmc_data *)ent->driver_data; const struct pmc_reg_map *map = data->map; 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"); /* Register platform clocks - PMC_PLT_CLK [0..5] */ ret = pmc_setup_clks(pdev, pmc->regmap, data); if (ret) dev_warn(&pdev->dev, "platform clocks register failed: %d\n", ret); pmc->init = true; return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li12961.72%228.57%
Irina Tirdea4320.57%114.29%
Andy Shevchenko3617.22%342.86%
Martin Kelly10.48%114.29%
Total209100.00%7100.00%

/* * 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_data }, { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_CHT_PMC), (kernel_ulong_t)&cht_data }, { 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; }

Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li4989.09%125.00%
Andy Shevchenko610.91%375.00%
Total55100.00%4100.00%

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"); */

Overall Contributors

PersonTokensPropCommitsCommitProp
Aubrey Li92342.28%318.75%
Andy Shevchenko92042.14%850.00%
Irina Tirdea30513.97%212.50%
Martin Kelly170.78%16.25%
Dan Carpenter150.69%16.25%
Paul Gortmaker30.14%16.25%
Total2183100.00%16100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.