1
2
3
4
5
6
7#include <linux/module.h>
8#include <linux/errno.h>
9#include <linux/kernel.h>
10#include <linux/init.h>
11#include <linux/mutex.h>
12#include <linux/pci.h>
13
14#include <linux/scx200.h>
15#include <linux/scx200_gpio.h>
16
17
18#define scx200_cb_probe(base) (inw((base) + SCx200_CBA) == (base))
19
20MODULE_AUTHOR("Christer Weinigel <wingel@nano-system.com>");
21MODULE_DESCRIPTION("NatSemi SCx200 Driver");
22MODULE_LICENSE("GPL");
23
24unsigned scx200_gpio_base = 0;
25unsigned long scx200_gpio_shadow[2];
26
27unsigned scx200_cb_base = 0;
28
29static struct pci_device_id scx200_tbl[] = {
30 { PCI_VDEVICE(NS, PCI_DEVICE_ID_NS_SCx200_BRIDGE) },
31 { PCI_VDEVICE(NS, PCI_DEVICE_ID_NS_SC1100_BRIDGE) },
32 { PCI_VDEVICE(NS, PCI_DEVICE_ID_NS_SCx200_XBUS) },
33 { PCI_VDEVICE(NS, PCI_DEVICE_ID_NS_SC1100_XBUS) },
34 { },
35};
36MODULE_DEVICE_TABLE(pci,scx200_tbl);
37
38static int scx200_probe(struct pci_dev *, const struct pci_device_id *);
39
40static struct pci_driver scx200_pci_driver = {
41 .name = "scx200",
42 .id_table = scx200_tbl,
43 .probe = scx200_probe,
44};
45
46static DEFINE_MUTEX(scx200_gpio_config_lock);
47
48static void scx200_init_shadow(void)
49{
50 int bank;
51
52
53 for (bank = 0; bank < 2; ++bank)
54 scx200_gpio_shadow[bank] = inl(scx200_gpio_base + 0x10 * bank);
55}
56
57static int scx200_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
58{
59 unsigned base;
60
61 if (pdev->device == PCI_DEVICE_ID_NS_SCx200_BRIDGE ||
62 pdev->device == PCI_DEVICE_ID_NS_SC1100_BRIDGE) {
63 base = pci_resource_start(pdev, 0);
64 pr_info("GPIO base 0x%x\n", base);
65
66 if (!request_region(base, SCx200_GPIO_SIZE,
67 "NatSemi SCx200 GPIO")) {
68 pr_err("can't allocate I/O for GPIOs\n");
69 return -EBUSY;
70 }
71
72 scx200_gpio_base = base;
73 scx200_init_shadow();
74
75 } else {
76
77 if (scx200_cb_probe(SCx200_CB_BASE_FIXED)) {
78 scx200_cb_base = SCx200_CB_BASE_FIXED;
79 } else {
80 pci_read_config_dword(pdev, SCx200_CBA_SCRATCH, &base);
81 if (scx200_cb_probe(base)) {
82 scx200_cb_base = base;
83 } else {
84 pr_warn("Configuration Block not found\n");
85 return -ENODEV;
86 }
87 }
88 pr_info("Configuration Block base 0x%x\n", scx200_cb_base);
89 }
90
91 return 0;
92}
93
94u32 scx200_gpio_configure(unsigned index, u32 mask, u32 bits)
95{
96 u32 config, new_config;
97
98 mutex_lock(&scx200_gpio_config_lock);
99
100 outl(index, scx200_gpio_base + 0x20);
101 config = inl(scx200_gpio_base + 0x24);
102
103 new_config = (config & mask) | bits;
104 outl(new_config, scx200_gpio_base + 0x24);
105
106 mutex_unlock(&scx200_gpio_config_lock);
107
108 return config;
109}
110
111static int __init scx200_init(void)
112{
113 pr_info("NatSemi SCx200 Driver\n");
114 return pci_register_driver(&scx200_pci_driver);
115}
116
117static void __exit scx200_cleanup(void)
118{
119 pci_unregister_driver(&scx200_pci_driver);
120 release_region(scx200_gpio_base, SCx200_GPIO_SIZE);
121}
122
123module_init(scx200_init);
124module_exit(scx200_cleanup);
125
126EXPORT_SYMBOL(scx200_gpio_base);
127EXPORT_SYMBOL(scx200_gpio_shadow);
128EXPORT_SYMBOL(scx200_gpio_configure);
129EXPORT_SYMBOL(scx200_cb_base);
130