1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/init.h>
27#include <linux/kernel.h>
28#include <linux/module.h>
29#include <linux/errno.h>
30#include <linux/acpi.h>
31#include <linux/pci.h>
32#include <linux/mfd/core.h>
33
34#define SMBASE 0x40
35#define SMBUS_IO_SIZE 64
36
37#define GPIOBASE 0x44
38#define GPIO_IO_SIZE 64
39
40static struct resource smbus_sch_resource = {
41 .flags = IORESOURCE_IO,
42};
43
44
45static struct resource gpio_sch_resource = {
46 .flags = IORESOURCE_IO,
47};
48
49static struct mfd_cell lpc_sch_cells[] = {
50 {
51 .name = "isch_smbus",
52 .num_resources = 1,
53 .resources = &smbus_sch_resource,
54 },
55 {
56 .name = "sch_gpio",
57 .num_resources = 1,
58 .resources = &gpio_sch_resource,
59 },
60};
61
62static struct pci_device_id lpc_sch_ids[] = {
63 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_SCH_LPC) },
64 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ITC_LPC) },
65 { 0, }
66};
67MODULE_DEVICE_TABLE(pci, lpc_sch_ids);
68
69static int __devinit lpc_sch_probe(struct pci_dev *dev,
70 const struct pci_device_id *id)
71{
72 unsigned int base_addr_cfg;
73 unsigned short base_addr;
74 int i;
75
76 pci_read_config_dword(dev, SMBASE, &base_addr_cfg);
77 if (!(base_addr_cfg & (1 << 31))) {
78 dev_err(&dev->dev, "Decode of the SMBus I/O range disabled\n");
79 return -ENODEV;
80 }
81 base_addr = (unsigned short)base_addr_cfg;
82 if (base_addr == 0) {
83 dev_err(&dev->dev, "I/O space for SMBus uninitialized\n");
84 return -ENODEV;
85 }
86
87 smbus_sch_resource.start = base_addr;
88 smbus_sch_resource.end = base_addr + SMBUS_IO_SIZE - 1;
89
90 pci_read_config_dword(dev, GPIOBASE, &base_addr_cfg);
91 if (!(base_addr_cfg & (1 << 31))) {
92 dev_err(&dev->dev, "Decode of the GPIO I/O range disabled\n");
93 return -ENODEV;
94 }
95 base_addr = (unsigned short)base_addr_cfg;
96 if (base_addr == 0) {
97 dev_err(&dev->dev, "I/O space for GPIO uninitialized\n");
98 return -ENODEV;
99 }
100
101 gpio_sch_resource.start = base_addr;
102 gpio_sch_resource.end = base_addr + GPIO_IO_SIZE - 1;
103
104 for (i=0; i < ARRAY_SIZE(lpc_sch_cells); i++)
105 lpc_sch_cells[i].id = id->device;
106
107 return mfd_add_devices(&dev->dev, 0,
108 lpc_sch_cells, ARRAY_SIZE(lpc_sch_cells), NULL, 0);
109}
110
111static void __devexit lpc_sch_remove(struct pci_dev *dev)
112{
113 mfd_remove_devices(&dev->dev);
114}
115
116static struct pci_driver lpc_sch_driver = {
117 .name = "lpc_sch",
118 .id_table = lpc_sch_ids,
119 .probe = lpc_sch_probe,
120 .remove = __devexit_p(lpc_sch_remove),
121};
122
123static int __init lpc_sch_init(void)
124{
125 return pci_register_driver(&lpc_sch_driver);
126}
127
128static void __exit lpc_sch_exit(void)
129{
130 pci_unregister_driver(&lpc_sch_driver);
131}
132
133module_init(lpc_sch_init);
134module_exit(lpc_sch_exit);
135
136MODULE_AUTHOR("Denis Turischev <denis@compulab.co.il>");
137MODULE_DESCRIPTION("LPC interface for Intel Poulsbo SCH");
138MODULE_LICENSE("GPL");
139