| // SPDX-License-Identifier: GPL-2.0-only | |
| /* | |
| * Intel Atom SoC Power Management Controller Driver | |
| * Copyright (c) 2014-2015,2017,2022 Intel Corporation. | |
| */ | |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | |
| #include <linux/acpi.h> | |
| #include <linux/debugfs.h> | |
| #include <linux/device.h> | |
| #include <linux/dmi.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_data/x86/simatic-ipc.h> | |
| #include <linux/platform_device.h> | |
| #include <linux/pci.h> | |
| #include <linux/seq_file.h> | |
| #include <linux/suspend.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); | |
| } | |
| 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; | |
| } | |
| 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; | |
| } | |
| 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; | |
| } | |
| 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; | |
| } | |
| DEFINE_SHOW_ATTRIBUTE(pmc_sleep_tmr); | |
| static void pmc_dbgfs_register(struct pmc_dev *pmc) | |
| { | |
| struct dentry *dir; | |
| dir = debugfs_create_dir("pmc_atom", NULL); | |
| pmc->dbgfs_dir = dir; | |
| debugfs_create_file("dev_state", S_IFREG | S_IRUGO, dir, pmc, | |
| &pmc_dev_state_fops); | |
| debugfs_create_file("pss_state", S_IFREG | S_IRUGO, dir, pmc, | |
| &pmc_pss_state_fops); | |
| debugfs_create_file("sleep_state", S_IFREG | S_IRUGO, dir, pmc, | |
| &pmc_sleep_tmr_fops); | |
| } | |
| #else | |
| static void pmc_dbgfs_register(struct pmc_dev *pmc) | |
| { | |
| } | |
| #endif /* CONFIG_DEBUG_FS */ | |
| static bool pmc_clk_is_critical = true; | |
| static int dmi_callback(const struct dmi_system_id *d) | |
| { | |
| pr_info("%s: PMC critical clocks quirk enabled\n", d->ident); | |
| return 1; | |
| } | |
| static int dmi_callback_siemens(const struct dmi_system_id *d) | |
| { | |
| u32 st_id; | |
| if (dmi_walk(simatic_ipc_find_dmi_entry_helper, &st_id)) | |
| goto out; | |
| if (st_id == SIMATIC_IPC_IPC227E || st_id == SIMATIC_IPC_IPC277E) | |
| return dmi_callback(d); | |
| out: | |
| pmc_clk_is_critical = false; | |
| return 1; | |
| } | |
| /* | |
| * Some systems need one or more of their pmc_plt_clks to be | |
| * marked as critical. | |
| */ | |
| static const struct dmi_system_id critclk_systems[] = { | |
| { | |
| /* pmc_plt_clk0 is used for an external HSIC USB HUB */ | |
| .ident = "MPL CEC1x", | |
| .callback = dmi_callback, | |
| .matches = { | |
| DMI_MATCH(DMI_SYS_VENDOR, "MPL AG"), | |
| DMI_MATCH(DMI_PRODUCT_NAME, "CEC10 Family"), | |
| }, | |
| }, | |
| { | |
| /* | |
| * Lex System / Lex Computech Co. makes a lot of Bay Trail | |
| * based embedded boards which often come with multiple | |
| * ethernet controllers using multiple pmc_plt_clks. See: | |
| * https://www.lex.com.tw/products/embedded-ipc-board/ | |
| */ | |
| .ident = "Lex BayTrail", | |
| .callback = dmi_callback, | |
| .matches = { | |
| DMI_MATCH(DMI_SYS_VENDOR, "Lex BayTrail"), | |
| }, | |
| }, | |
| { | |
| /* pmc_plt_clk* - are used for ethernet controllers */ | |
| .ident = "Beckhoff Baytrail", | |
| .callback = dmi_callback, | |
| .matches = { | |
| DMI_MATCH(DMI_SYS_VENDOR, "Beckhoff Automation"), | |
| DMI_MATCH(DMI_PRODUCT_FAMILY, "CBxx63"), | |
| }, | |
| }, | |
| { | |
| .ident = "SIEMENS AG", | |
| .callback = dmi_callback_siemens, | |
| .matches = { | |
| DMI_MATCH(DMI_SYS_VENDOR, "SIEMENS AG"), | |
| }, | |
| }, | |
| {} | |
| }; | |
| 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_obj(*clk_data); | |
| if (!clk_data) | |
| return -ENOMEM; | |
| clk_data->base = pmc_regmap; /* offset is added by client */ | |
| clk_data->clks = pmc_data->clks; | |
| if (dmi_check_system(critclk_systems)) | |
| clk_data->critical = pmc_clk_is_critical; | |
| 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; | |
| } | |
| #ifdef CONFIG_SUSPEND | |
| static void pmc_dev_state_check(u32 sts, const struct pmc_bit_map *sts_map, | |
| u32 fd, const struct pmc_bit_map *fd_map, | |
| u32 sts_possible_false_pos) | |
| { | |
| int index; | |
| for (index = 0; sts_map[index].name; index++) { | |
| if (!(fd_map[index].bit_mask & fd) && | |
| !(sts_map[index].bit_mask & sts)) { | |
| if (sts_map[index].bit_mask & sts_possible_false_pos) | |
| pm_pr_dbg("%s is in D0 prior to s2idle\n", | |
| sts_map[index].name); | |
| else | |
| pr_err("%s is in D0 prior to s2idle\n", | |
| sts_map[index].name); | |
| } | |
| } | |
| } | |
| static void pmc_s2idle_check(void) | |
| { | |
| struct pmc_dev *pmc = &pmc_device; | |
| const struct pmc_reg_map *m = pmc->map; | |
| u32 func_dis, func_dis_2; | |
| u32 d3_sts_0, d3_sts_1; | |
| u32 false_pos_sts_0, false_pos_sts_1; | |
| int i; | |
| 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); | |
| /* | |
| * Some blocks are not used on lower-featured versions of the SoC and | |
| * always report D0, add these to false_pos mask to log at debug level. | |
| */ | |
| if (m->d3_sts_1 == byt_d3_sts_1_map) { | |
| /* Bay Trail */ | |
| false_pos_sts_0 = BIT_GBE | BIT_SATA | BIT_PCIE_PORT0 | | |
| BIT_PCIE_PORT1 | BIT_PCIE_PORT2 | BIT_PCIE_PORT3 | | |
| BIT_LPSS2_F5_I2C5; | |
| false_pos_sts_1 = BIT_SMB | BIT_USH_SS_PHY | BIT_DFX; | |
| } else { | |
| /* Cherry Trail */ | |
| false_pos_sts_0 = BIT_GBE | BIT_SATA | BIT_LPSS2_F7_I2C7; | |
| false_pos_sts_1 = BIT_SMB | BIT_STS_ISH; | |
| } | |
| pmc_dev_state_check(d3_sts_0, m->d3_sts_0, func_dis, m->func_dis, false_pos_sts_0); | |
| pmc_dev_state_check(d3_sts_1, m->d3_sts_1, func_dis_2, m->func_dis_2, false_pos_sts_1); | |
| /* Forced-on PMC clocks prevent S0i3 */ | |
| for (i = 0; i < PMC_CLK_NUM; i++) { | |
| u32 ctl = pmc_reg_read(pmc, PMC_CLK_CTL_OFFSET + 4 * i); | |
| if ((ctl & PMC_MASK_CLK_CTL) != PMC_CLK_CTL_FORCE_ON) | |
| continue; | |
| pr_err("clock %d is ON prior to freeze (ctl 0x%08x)\n", i, ctl); | |
| } | |
| } | |
| static struct acpi_s2idle_dev_ops pmc_s2idle_ops = { | |
| .check = pmc_s2idle_check, | |
| }; | |
| static void pmc_s2idle_check_register(void) | |
| { | |
| acpi_register_lps0_dev(&pmc_s2idle_ops); | |
| } | |
| #else | |
| static void pmc_s2idle_check_register(void) {} | |
| #endif | |
| 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(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); | |
| pmc_dbgfs_register(pmc); | |
| /* 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_s2idle_check_register(); | |
| 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), .driver_data = (kernel_ulong_t)&byt_data }, | |
| { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_CHT_PMC), .driver_data = (kernel_ulong_t)&cht_data }, | |
| {} | |
| }; | |
| 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 maximum 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"); | |
| */ |