LXR linux/arch/i386/kernel/scx200.c

   1/* linux/arch/i386/kernel/scx200.c 
   2
   3   Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>
   4
   5   National Semiconductor SCx200 support. */
   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/* Verify that the configuration block really is there */
  18#define scx200_cb_probe(base) (inw((base) + SCx200_CBA) == (base))
  19
  20#define NAME "scx200"
  21
  22MODULE_AUTHOR("Christer Weinigel <wingel@nano-system.com>");
  23MODULE_DESCRIPTION("NatSemi SCx200 Driver");
  24MODULE_LICENSE("GPL");
  25
  26unsigned scx200_gpio_base = 0;
  27long scx200_gpio_shadow[2];
  28
  29unsigned scx200_cb_base = 0;
  30
  31static 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        { },
  37};
  38MODULE_DEVICE_TABLE(pci,scx200_tbl);
  39
  40static int __devinit scx200_probe(struct pci_dev *, const struct pci_device_id *);
  41
  42static struct pci_driver scx200_pci_driver = {
  43        .name = "scx200",
  44        .id_table = scx200_tbl,
  45        .probe = scx200_probe,
  46};
  47
  48static DEFINE_MUTEX(scx200_gpio_config_lock);
  49
  50static void __devinit scx200_init_shadow(void)
  51{
  52        int bank;
  53
  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);
  57}
  58
  59static int __devinit scx200_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
  60{
  61        unsigned base;
  62
  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);
  67
  68                if (request_region(base, SCx200_GPIO_SIZE, "NatSemi SCx200 GPIO") == 0) {
  69                        printk(KERN_ERR NAME ": can't allocate I/O for GPIOs\n");
  70                        return -EBUSY;
  71                }
  72
  73                scx200_gpio_base = base;
  74                scx200_init_shadow();
  75
  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;
  87                        }
  88                }
  89                printk(KERN_INFO NAME ": Configuration Block base 0x%x\n", scx200_cb_base);
  90        }
  91
  92        return 0;
  93}
  94
  95u32 scx200_gpio_configure(unsigned index, u32 mask, u32 bits)
  96{
  97        u32 config, new_config;
  98
  99        mutex_lock(&scx200_gpio_config_lock);
 100
 101        outl(index, scx200_gpio_base + 0x20);
 102        config = inl(scx200_gpio_base + 0x24);
 103
 104        new_config = (config & mask) | bits;
 105        outl(new_config, scx200_gpio_base + 0x24);
 106
 107        mutex_unlock(&scx200_gpio_config_lock);
 108
 109        return config;
 110}
 111
 112static int __init scx200_init(void)
 113{
 114        printk(KERN_INFO NAME ": NatSemi SCx200 Driver\n");
 115
 116        return pci_register_driver(&scx200_pci_driver);
 117}
 118
 119static void __exit scx200_cleanup(void)
 120{
 121        pci_unregister_driver(&scx200_pci_driver);
 122        release_region(scx200_gpio_base, SCx200_GPIO_SIZE);
 123}
 124
 125module_init(scx200_init);
 126module_exit(scx200_cleanup);
 127
 128EXPORT_SYMBOL(scx200_gpio_base);
 129EXPORT_SYMBOL(scx200_gpio_shadow);
 130EXPORT_SYMBOL(scx200_gpio_configure);
 131EXPORT_SYMBOL(scx200_cb_base);
 132