PageRenderTime 26ms CodeModel.GetById 21ms app.highlight 4ms RepoModel.GetById 0ms app.codeStats 0ms

/arch/x86/platform/scx200/scx200_32.c

https://bitbucket.org/ndreys/linux-sunxi
C | 131 lines | 93 code | 30 blank | 8 comment | 11 complexity | cc414953ebd6bf80a710e1db6c61f882 MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
  1/*
  2 *  Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com>
  3 *
  4 *  National Semiconductor SCx200 support.
  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/* 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;
 27unsigned long 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")) {
 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);