1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
17
18#include <linux/module.h>
19#include <linux/init.h>
20#include <linux/pci.h>
21#include <linux/device.h>
22#include <linux/debugfs.h>
23#include <linux/seq_file.h>
24#include <linux/io.h>
25
26#include <asm/pmc_atom.h>
27
28#define DRIVER_NAME KBUILD_MODNAME
29
30struct pmc_dev {
31 u32 base_addr;
32 void __iomem *regmap;
33#ifdef CONFIG_DEBUG_FS
34 struct dentry *dbgfs_dir;
35#endif
36};
37
38static struct pmc_dev pmc_device;
39static u32 acpi_base_addr;
40
41struct pmc_dev_map {
42 const char *name;
43 u32 bit_mask;
44};
45
46static const struct pmc_dev_map dev_map[] = {
47 {"0 - LPSS1_F0_DMA", BIT_LPSS1_F0_DMA},
48 {"1 - LPSS1_F1_PWM1", BIT_LPSS1_F1_PWM1},
49 {"2 - LPSS1_F2_PWM2", BIT_LPSS1_F2_PWM2},
50 {"3 - LPSS1_F3_HSUART1", BIT_LPSS1_F3_HSUART1},
51 {"4 - LPSS1_F4_HSUART2", BIT_LPSS1_F4_HSUART2},
52 {"5 - LPSS1_F5_SPI", BIT_LPSS1_F5_SPI},
53 {"6 - LPSS1_F6_Reserved", BIT_LPSS1_F6_XXX},
54 {"7 - LPSS1_F7_Reserved", BIT_LPSS1_F7_XXX},
55 {"8 - SCC_EMMC", BIT_SCC_EMMC},
56 {"9 - SCC_SDIO", BIT_SCC_SDIO},
57 {"10 - SCC_SDCARD", BIT_SCC_SDCARD},
58 {"11 - SCC_MIPI", BIT_SCC_MIPI},
59 {"12 - HDA", BIT_HDA},
60 {"13 - LPE", BIT_LPE},
61 {"14 - OTG", BIT_OTG},
62 {"15 - USH", BIT_USH},
63 {"16 - GBE", BIT_GBE},
64 {"17 - SATA", BIT_SATA},
65 {"18 - USB_EHCI", BIT_USB_EHCI},
66 {"19 - SEC", BIT_SEC},
67 {"20 - PCIE_PORT0", BIT_PCIE_PORT0},
68 {"21 - PCIE_PORT1", BIT_PCIE_PORT1},
69 {"22 - PCIE_PORT2", BIT_PCIE_PORT2},
70 {"23 - PCIE_PORT3", BIT_PCIE_PORT3},
71 {"24 - LPSS2_F0_DMA", BIT_LPSS2_F0_DMA},
72 {"25 - LPSS2_F1_I2C1", BIT_LPSS2_F1_I2C1},
73 {"26 - LPSS2_F2_I2C2", BIT_LPSS2_F2_I2C2},
74 {"27 - LPSS2_F3_I2C3", BIT_LPSS2_F3_I2C3},
75 {"28 - LPSS2_F3_I2C4", BIT_LPSS2_F4_I2C4},
76 {"29 - LPSS2_F5_I2C5", BIT_LPSS2_F5_I2C5},
77 {"30 - LPSS2_F6_I2C6", BIT_LPSS2_F6_I2C6},
78 {"31 - LPSS2_F7_I2C7", BIT_LPSS2_F7_I2C7},
79 {"32 - SMB", BIT_SMB},
80 {"33 - OTG_SS_PHY", BIT_OTG_SS_PHY},
81 {"34 - USH_SS_PHY", BIT_USH_SS_PHY},
82 {"35 - DFX", BIT_DFX},
83};
84
85static inline u32 pmc_reg_read(struct pmc_dev *pmc, int reg_offset)
86{
87 return readl(pmc->regmap + reg_offset);
88}
89
90static inline void pmc_reg_write(struct pmc_dev *pmc, int reg_offset, u32 val)
91{
92 writel(val, pmc->regmap + reg_offset);
93}
94
95static void pmc_power_off(void)
96{
97 u16 pm1_cnt_port;
98 u32 pm1_cnt_value;
99
100 pr_info("Preparing to enter system sleep state S5\n");
101
102 pm1_cnt_port = acpi_base_addr + PM1_CNT;
103
104 pm1_cnt_value = inl(pm1_cnt_port);
105 pm1_cnt_value &= SLEEP_TYPE_MASK;
106 pm1_cnt_value |= SLEEP_TYPE_S5;
107 pm1_cnt_value |= SLEEP_ENABLE;
108
109 outl(pm1_cnt_value, pm1_cnt_port);
110}
111
112static void pmc_hw_reg_setup(struct pmc_dev *pmc)
113{
114
115
116
117
118
119
120
121
122 pmc_reg_write(pmc, PMC_S0IX_WAKE_EN, (u32)PMC_WAKE_EN_SETTING);
123}
124
125#ifdef CONFIG_DEBUG_FS
126static int pmc_dev_state_show(struct seq_file *s, void *unused)
127{
128 struct pmc_dev *pmc = s->private;
129 u32 func_dis, func_dis_2, func_dis_index;
130 u32 d3_sts_0, d3_sts_1, d3_sts_index;
131 int dev_num, dev_index, reg_index;
132
133 func_dis = pmc_reg_read(pmc, PMC_FUNC_DIS);
134 func_dis_2 = pmc_reg_read(pmc, PMC_FUNC_DIS_2);
135 d3_sts_0 = pmc_reg_read(pmc, PMC_D3_STS_0);
136 d3_sts_1 = pmc_reg_read(pmc, PMC_D3_STS_1);
137
138 dev_num = ARRAY_SIZE(dev_map);
139
140 for (dev_index = 0; dev_index < dev_num; dev_index++) {
141 reg_index = dev_index / PMC_REG_BIT_WIDTH;
142 if (reg_index) {
143 func_dis_index = func_dis_2;
144 d3_sts_index = d3_sts_1;
145 } else {
146 func_dis_index = func_dis;
147 d3_sts_index = d3_sts_0;
148 }
149
150 seq_printf(s, "Dev: %-32s\tState: %s [%s]\n",
151 dev_map[dev_index].name,
152 dev_map[dev_index].bit_mask & func_dis_index ?
153 "Disabled" : "Enabled ",
154 dev_map[dev_index].bit_mask & d3_sts_index ?
155 "D3" : "D0");
156 }
157 return 0;
158}
159
160static int pmc_dev_state_open(struct inode *inode, struct file *file)
161{
162 return single_open(file, pmc_dev_state_show, inode->i_private);
163}
164
165static const struct file_operations pmc_dev_state_ops = {
166 .open = pmc_dev_state_open,
167 .read = seq_read,
168 .llseek = seq_lseek,
169 .release = single_release,
170};
171
172static int pmc_sleep_tmr_show(struct seq_file *s, void *unused)
173{
174 struct pmc_dev *pmc = s->private;
175 u64 s0ir_tmr, s0i1_tmr, s0i2_tmr, s0i3_tmr, s0_tmr;
176
177 s0ir_tmr = (u64)pmc_reg_read(pmc, PMC_S0IR_TMR) << PMC_TMR_SHIFT;
178 s0i1_tmr = (u64)pmc_reg_read(pmc, PMC_S0I1_TMR) << PMC_TMR_SHIFT;
179 s0i2_tmr = (u64)pmc_reg_read(pmc, PMC_S0I2_TMR) << PMC_TMR_SHIFT;
180 s0i3_tmr = (u64)pmc_reg_read(pmc, PMC_S0I3_TMR) << PMC_TMR_SHIFT;
181 s0_tmr = (u64)pmc_reg_read(pmc, PMC_S0_TMR) << PMC_TMR_SHIFT;
182
183 seq_printf(s, "S0IR Residency:\t%lldus\n", s0ir_tmr);
184 seq_printf(s, "S0I1 Residency:\t%lldus\n", s0i1_tmr);
185 seq_printf(s, "S0I2 Residency:\t%lldus\n", s0i2_tmr);
186 seq_printf(s, "S0I3 Residency:\t%lldus\n", s0i3_tmr);
187 seq_printf(s, "S0 Residency:\t%lldus\n", s0_tmr);
188 return 0;
189}
190
191static int pmc_sleep_tmr_open(struct inode *inode, struct file *file)
192{
193 return single_open(file, pmc_sleep_tmr_show, inode->i_private);
194}
195
196static const struct file_operations pmc_sleep_tmr_ops = {
197 .open = pmc_sleep_tmr_open,
198 .read = seq_read,
199 .llseek = seq_lseek,
200 .release = single_release,
201};
202
203static void pmc_dbgfs_unregister(struct pmc_dev *pmc)
204{
205 if (!pmc->dbgfs_dir)
206 return;
207
208 debugfs_remove_recursive(pmc->dbgfs_dir);
209 pmc->dbgfs_dir = NULL;
210}
211
212static int pmc_dbgfs_register(struct pmc_dev *pmc, struct pci_dev *pdev)
213{
214 struct dentry *dir, *f;
215
216 dir = debugfs_create_dir("pmc_atom", NULL);
217 if (!dir)
218 return -ENOMEM;
219
220 f = debugfs_create_file("dev_state", S_IFREG | S_IRUGO,
221 dir, pmc, &pmc_dev_state_ops);
222 if (!f) {
223 dev_err(&pdev->dev, "dev_states register failed\n");
224 goto err;
225 }
226 f = debugfs_create_file("sleep_state", S_IFREG | S_IRUGO,
227 dir, pmc, &pmc_sleep_tmr_ops);
228 if (!f) {
229 dev_err(&pdev->dev, "sleep_state register failed\n");
230 goto err;
231 }
232 pmc->dbgfs_dir = dir;
233 return 0;
234err:
235 pmc_dbgfs_unregister(pmc);
236 return -ENODEV;
237}
238#endif
239
240static int pmc_setup_dev(struct pci_dev *pdev)
241{
242 struct pmc_dev *pmc = &pmc_device;
243 int ret;
244
245
246 pci_read_config_dword(pdev, ACPI_BASE_ADDR_OFFSET, &acpi_base_addr);
247 acpi_base_addr &= ACPI_BASE_ADDR_MASK;
248
249
250 if (acpi_base_addr != 0 && pm_power_off == NULL)
251 pm_power_off = pmc_power_off;
252
253 pci_read_config_dword(pdev, PMC_BASE_ADDR_OFFSET, &pmc->base_addr);
254 pmc->base_addr &= PMC_BASE_ADDR_MASK;
255
256 pmc->regmap = ioremap_nocache(pmc->base_addr, PMC_MMIO_REG_LEN);
257 if (!pmc->regmap) {
258 dev_err(&pdev->dev, "error: ioremap failed\n");
259 return -ENOMEM;
260 }
261
262
263 pmc_hw_reg_setup(pmc);
264
265#ifdef CONFIG_DEBUG_FS
266 ret = pmc_dbgfs_register(pmc, pdev);
267 if (ret) {
268 iounmap(pmc->regmap);
269 return ret;
270 }
271#endif
272 return 0;
273}
274
275
276
277
278
279
280
281
282
283static const struct pci_device_id pmc_pci_ids[] = {
284 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_VLV_PMC) },
285 { 0, },
286};
287
288MODULE_DEVICE_TABLE(pci, pmc_pci_ids);
289
290static int __init pmc_atom_init(void)
291{
292 int err = -ENODEV;
293 struct pci_dev *pdev = NULL;
294 const struct pci_device_id *ent;
295
296
297
298
299
300
301
302
303
304 for_each_pci_dev(pdev) {
305 ent = pci_match_id(pmc_pci_ids, pdev);
306 if (ent) {
307 err = pmc_setup_dev(pdev);
308 goto out;
309 }
310 }
311
312out:
313 return err;
314}
315
316module_init(pmc_atom_init);
317
318
319MODULE_AUTHOR("Aubrey Li <aubrey.li@linux.intel.com>");
320MODULE_DESCRIPTION("Intel Atom SOC Power Management Controller Interface");
321MODULE_LICENSE("GPL v2");
322