Loading drivers/gpio/cs5535-gpio.c +31 −62 Original line number Diff line number Diff line Loading @@ -11,14 +11,13 @@ #include <linux/kernel.h> #include <linux/spinlock.h> #include <linux/module.h> #include <linux/pci.h> #include <linux/platform_device.h> #include <linux/gpio.h> #include <linux/io.h> #include <linux/cs5535.h> #include <asm/msr.h> #define DRV_NAME "cs5535-gpio" #define GPIO_BAR 1 /* * Some GPIO pins Loading Loading @@ -47,7 +46,7 @@ static struct cs5535_gpio_chip { struct gpio_chip chip; resource_size_t base; struct pci_dev *pdev; struct platform_device *pdev; spinlock_t lock; } cs5535_gpio_chip; Loading Loading @@ -301,10 +300,10 @@ static struct cs5535_gpio_chip cs5535_gpio_chip = { }, }; static int __init cs5535_gpio_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id) static int __devinit cs5535_gpio_probe(struct platform_device *pdev) { int err; struct resource *res; int err = -EIO; ulong mask_orig = mask; /* There are two ways to get the GPIO base address; one is by Loading @@ -314,25 +313,24 @@ static int __init cs5535_gpio_probe(struct pci_dev *pdev, * it turns out to be unreliable in the face of crappy BIOSes, we * can always go back to using MSRs.. */ err = pci_enable_device_io(pdev); if (err) { dev_err(&pdev->dev, "can't enable device IO\n"); res = platform_get_resource(pdev, IORESOURCE_IO, 0); if (!res) { dev_err(&pdev->dev, "can't fetch device resource info\n"); goto done; } err = pci_request_region(pdev, GPIO_BAR, DRV_NAME); if (err) { dev_err(&pdev->dev, "can't alloc PCI BAR #%d\n", GPIO_BAR); if (!request_region(res->start, resource_size(res), pdev->name)) { dev_err(&pdev->dev, "can't request region\n"); goto done; } /* set up the driver-specific struct */ cs5535_gpio_chip.base = pci_resource_start(pdev, GPIO_BAR); cs5535_gpio_chip.base = res->start; cs5535_gpio_chip.pdev = pdev; spin_lock_init(&cs5535_gpio_chip.lock); dev_info(&pdev->dev, "allocated PCI BAR #%d: base 0x%llx\n", GPIO_BAR, (unsigned long long) cs5535_gpio_chip.base); dev_info(&pdev->dev, "region 0x%x - 0x%x reserved\n", res->start, res->end); /* mask out reserved pins */ mask &= 0x1F7FFFFF; Loading @@ -350,78 +348,49 @@ static int __init cs5535_gpio_probe(struct pci_dev *pdev, if (err) goto release_region; dev_info(&pdev->dev, DRV_NAME ": GPIO support successfully loaded.\n"); dev_info(&pdev->dev, "GPIO support successfully loaded.\n"); return 0; release_region: pci_release_region(pdev, GPIO_BAR); release_region(res->start, resource_size(res)); done: return err; } static void __exit cs5535_gpio_remove(struct pci_dev *pdev) static int __devexit cs5535_gpio_remove(struct platform_device *pdev) { struct resource *r; int err; err = gpiochip_remove(&cs5535_gpio_chip.chip); if (err) { /* uhh? */ dev_err(&pdev->dev, "unable to remove gpio_chip?\n"); } pci_release_region(pdev, GPIO_BAR); } static struct pci_device_id cs5535_gpio_pci_tbl[] = { { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_CS5535_ISA) }, { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_CS5536_ISA) }, { 0, }, }; MODULE_DEVICE_TABLE(pci, cs5535_gpio_pci_tbl); /* * We can't use the standard PCI driver registration stuff here, since * that allows only one driver to bind to each PCI device (and we want * multiple drivers to be able to bind to the device). Instead, manually * scan for the PCI device, request a single region, and keep track of the * devices that we're using. */ static int __init cs5535_gpio_scan_pci(void) { struct pci_dev *pdev; int err = -ENODEV; int i; for (i = 0; i < ARRAY_SIZE(cs5535_gpio_pci_tbl); i++) { pdev = pci_get_device(cs5535_gpio_pci_tbl[i].vendor, cs5535_gpio_pci_tbl[i].device, NULL); if (pdev) { err = cs5535_gpio_probe(pdev, &cs5535_gpio_pci_tbl[i]); if (err) pci_dev_put(pdev); /* we only support a single CS5535/6 southbridge */ break; } } return err; } static void __exit cs5535_gpio_free_pci(void) { cs5535_gpio_remove(cs5535_gpio_chip.pdev); pci_dev_put(cs5535_gpio_chip.pdev); r = platform_get_resource(pdev, IORESOURCE_IO, 0); release_region(r->start, resource_size(r)); return 0; } static struct platform_driver cs5535_gpio_drv = { .driver = { .name = DRV_NAME, .owner = THIS_MODULE, }, .probe = cs5535_gpio_probe, .remove = __devexit_p(cs5535_gpio_remove), }; static int __init cs5535_gpio_init(void) { return cs5535_gpio_scan_pci(); return platform_driver_register(&cs5535_gpio_drv); } static void __exit cs5535_gpio_exit(void) { cs5535_gpio_free_pci(); platform_driver_unregister(&cs5535_gpio_drv); } module_init(cs5535_gpio_init); Loading Loading
drivers/gpio/cs5535-gpio.c +31 −62 Original line number Diff line number Diff line Loading @@ -11,14 +11,13 @@ #include <linux/kernel.h> #include <linux/spinlock.h> #include <linux/module.h> #include <linux/pci.h> #include <linux/platform_device.h> #include <linux/gpio.h> #include <linux/io.h> #include <linux/cs5535.h> #include <asm/msr.h> #define DRV_NAME "cs5535-gpio" #define GPIO_BAR 1 /* * Some GPIO pins Loading Loading @@ -47,7 +46,7 @@ static struct cs5535_gpio_chip { struct gpio_chip chip; resource_size_t base; struct pci_dev *pdev; struct platform_device *pdev; spinlock_t lock; } cs5535_gpio_chip; Loading Loading @@ -301,10 +300,10 @@ static struct cs5535_gpio_chip cs5535_gpio_chip = { }, }; static int __init cs5535_gpio_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id) static int __devinit cs5535_gpio_probe(struct platform_device *pdev) { int err; struct resource *res; int err = -EIO; ulong mask_orig = mask; /* There are two ways to get the GPIO base address; one is by Loading @@ -314,25 +313,24 @@ static int __init cs5535_gpio_probe(struct pci_dev *pdev, * it turns out to be unreliable in the face of crappy BIOSes, we * can always go back to using MSRs.. */ err = pci_enable_device_io(pdev); if (err) { dev_err(&pdev->dev, "can't enable device IO\n"); res = platform_get_resource(pdev, IORESOURCE_IO, 0); if (!res) { dev_err(&pdev->dev, "can't fetch device resource info\n"); goto done; } err = pci_request_region(pdev, GPIO_BAR, DRV_NAME); if (err) { dev_err(&pdev->dev, "can't alloc PCI BAR #%d\n", GPIO_BAR); if (!request_region(res->start, resource_size(res), pdev->name)) { dev_err(&pdev->dev, "can't request region\n"); goto done; } /* set up the driver-specific struct */ cs5535_gpio_chip.base = pci_resource_start(pdev, GPIO_BAR); cs5535_gpio_chip.base = res->start; cs5535_gpio_chip.pdev = pdev; spin_lock_init(&cs5535_gpio_chip.lock); dev_info(&pdev->dev, "allocated PCI BAR #%d: base 0x%llx\n", GPIO_BAR, (unsigned long long) cs5535_gpio_chip.base); dev_info(&pdev->dev, "region 0x%x - 0x%x reserved\n", res->start, res->end); /* mask out reserved pins */ mask &= 0x1F7FFFFF; Loading @@ -350,78 +348,49 @@ static int __init cs5535_gpio_probe(struct pci_dev *pdev, if (err) goto release_region; dev_info(&pdev->dev, DRV_NAME ": GPIO support successfully loaded.\n"); dev_info(&pdev->dev, "GPIO support successfully loaded.\n"); return 0; release_region: pci_release_region(pdev, GPIO_BAR); release_region(res->start, resource_size(res)); done: return err; } static void __exit cs5535_gpio_remove(struct pci_dev *pdev) static int __devexit cs5535_gpio_remove(struct platform_device *pdev) { struct resource *r; int err; err = gpiochip_remove(&cs5535_gpio_chip.chip); if (err) { /* uhh? */ dev_err(&pdev->dev, "unable to remove gpio_chip?\n"); } pci_release_region(pdev, GPIO_BAR); } static struct pci_device_id cs5535_gpio_pci_tbl[] = { { PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_DEVICE_ID_NS_CS5535_ISA) }, { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_CS5536_ISA) }, { 0, }, }; MODULE_DEVICE_TABLE(pci, cs5535_gpio_pci_tbl); /* * We can't use the standard PCI driver registration stuff here, since * that allows only one driver to bind to each PCI device (and we want * multiple drivers to be able to bind to the device). Instead, manually * scan for the PCI device, request a single region, and keep track of the * devices that we're using. */ static int __init cs5535_gpio_scan_pci(void) { struct pci_dev *pdev; int err = -ENODEV; int i; for (i = 0; i < ARRAY_SIZE(cs5535_gpio_pci_tbl); i++) { pdev = pci_get_device(cs5535_gpio_pci_tbl[i].vendor, cs5535_gpio_pci_tbl[i].device, NULL); if (pdev) { err = cs5535_gpio_probe(pdev, &cs5535_gpio_pci_tbl[i]); if (err) pci_dev_put(pdev); /* we only support a single CS5535/6 southbridge */ break; } } return err; } static void __exit cs5535_gpio_free_pci(void) { cs5535_gpio_remove(cs5535_gpio_chip.pdev); pci_dev_put(cs5535_gpio_chip.pdev); r = platform_get_resource(pdev, IORESOURCE_IO, 0); release_region(r->start, resource_size(r)); return 0; } static struct platform_driver cs5535_gpio_drv = { .driver = { .name = DRV_NAME, .owner = THIS_MODULE, }, .probe = cs5535_gpio_probe, .remove = __devexit_p(cs5535_gpio_remove), }; static int __init cs5535_gpio_init(void) { return cs5535_gpio_scan_pci(); return platform_driver_register(&cs5535_gpio_drv); } static void __exit cs5535_gpio_exit(void) { cs5535_gpio_free_pci(); platform_driver_unregister(&cs5535_gpio_drv); } module_init(cs5535_gpio_init); Loading