Merge git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[wrt350n-kernel.git] / arch / x86 / kernel / scx200_32.c
blob7e004acbe52648918fd691765f6cafc86297b42b
1 /*
2 * Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>
4 * National Semiconductor SCx200 support.
5 */
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>
14 #include <linux/scx200.h>
15 #include <linux/scx200_gpio.h>
17 /* Verify that the configuration block really is there */
18 #define scx200_cb_probe(base) (inw((base) + SCx200_CBA) == (base))
20 #define NAME "scx200"
22 MODULE_AUTHOR("Christer Weinigel <wingel@nano-system.com>");
23 MODULE_DESCRIPTION("NatSemi SCx200 Driver");
24 MODULE_LICENSE("GPL");
26 unsigned scx200_gpio_base = 0;
27 unsigned long scx200_gpio_shadow[2];
29 unsigned scx200_cb_base = 0;
31 static struct pci_device_id scx200_tbl[] = {
32 { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_SCx200_BRIDGE) },
33 { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_SC1100_BRIDGE) },
34 { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_SCx200_XBUS) },
35 { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_SC1100_XBUS) },
36 { },
38 MODULE_DEVICE_TABLE(pci,scx200_tbl);
40 static int __devinit scx200_probe(struct pci_dev *, const struct pci_device_id *);
42 static struct pci_driver scx200_pci_driver = {
43 .name = "scx200",
44 .id_table = scx200_tbl,
45 .probe = scx200_probe,
48 static DEFINE_MUTEX(scx200_gpio_config_lock);
50 static void __devinit scx200_init_shadow(void)
52 int bank;
54 /* read the current values driven on the GPIO signals */
55 for (bank = 0; bank < 2; ++bank)
56 scx200_gpio_shadow[bank] = inl(scx200_gpio_base + 0x10 * bank);
59 static int __devinit scx200_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
61 unsigned base;
63 if (pdev->device == PCI_DEVICE_ID_NS_SCx200_BRIDGE ||
64 pdev->device == PCI_DEVICE_ID_NS_SC1100_BRIDGE) {
65 base = pci_resource_start(pdev, 0);
66 printk(KERN_INFO NAME ": GPIO base 0x%x\n", base);
68 if (!request_region(base, SCx200_GPIO_SIZE, "NatSemi SCx200 GPIO")) {
69 printk(KERN_ERR NAME ": can't allocate I/O for GPIOs\n");
70 return -EBUSY;
73 scx200_gpio_base = base;
74 scx200_init_shadow();
76 } else {
77 /* find the base of the Configuration Block */
78 if (scx200_cb_probe(SCx200_CB_BASE_FIXED)) {
79 scx200_cb_base = SCx200_CB_BASE_FIXED;
80 } else {
81 pci_read_config_dword(pdev, SCx200_CBA_SCRATCH, &base);
82 if (scx200_cb_probe(base)) {
83 scx200_cb_base = base;
84 } else {
85 printk(KERN_WARNING NAME ": Configuration Block not found\n");
86 return -ENODEV;
89 printk(KERN_INFO NAME ": Configuration Block base 0x%x\n", scx200_cb_base);
92 return 0;
95 u32 scx200_gpio_configure(unsigned index, u32 mask, u32 bits)
97 u32 config, new_config;
99 mutex_lock(&scx200_gpio_config_lock);
101 outl(index, scx200_gpio_base + 0x20);
102 config = inl(scx200_gpio_base + 0x24);
104 new_config = (config & mask) | bits;
105 outl(new_config, scx200_gpio_base + 0x24);
107 mutex_unlock(&scx200_gpio_config_lock);
109 return config;
112 static int __init scx200_init(void)
114 printk(KERN_INFO NAME ": NatSemi SCx200 Driver\n");
116 return pci_register_driver(&scx200_pci_driver);
119 static void __exit scx200_cleanup(void)
121 pci_unregister_driver(&scx200_pci_driver);
122 release_region(scx200_gpio_base, SCx200_GPIO_SIZE);
125 module_init(scx200_init);
126 module_exit(scx200_cleanup);
128 EXPORT_SYMBOL(scx200_gpio_base);
129 EXPORT_SYMBOL(scx200_gpio_shadow);
130 EXPORT_SYMBOL(scx200_gpio_configure);
131 EXPORT_SYMBOL(scx200_cb_base);