/* * AMD CS5535/CS5536 GPIO driver * Copyright (C) 2006 Advanced Micro Devices, Inc. * Copyright (C) 2007-2009 Andres Salomon * * This program is free software; you can redistribute it and/or * modify it under the terms of version 2 of the GNU General Public License * as published by the Free Software Foundation. */ #include #include #include #include #include #include #include #define DRV_NAME "cs5535-gpio" #define GPIO_BAR 1 static struct cs5535_gpio_chip { struct gpio_chip chip; resource_size_t base; struct pci_dev *pdev; spinlock_t lock; } cs5535_gpio_chip; /* * The CS5535/CS5536 GPIOs support a number of extra features not defined * by the gpio_chip API, so these are exported. For a full list of the * registers, see include/linux/cs5535.h. */ static void __cs5535_gpio_set(struct cs5535_gpio_chip *chip, unsigned offset, unsigned int reg) { if (offset < 16) /* low bank register */ outl(1 << offset, chip->base + reg); else /* high bank register */ outl(1 << (offset - 16), chip->base + 0x80 + reg); } void cs5535_gpio_set(unsigned offset, unsigned int reg) { struct cs5535_gpio_chip *chip = &cs5535_gpio_chip; unsigned long flags; spin_lock_irqsave(&chip->lock, flags); __cs5535_gpio_set(chip, offset, reg); spin_unlock_irqrestore(&chip->lock, flags); } EXPORT_SYMBOL_GPL(cs5535_gpio_set); static void __cs5535_gpio_clear(struct cs5535_gpio_chip *chip, unsigned offset, unsigned int reg) { if (offset < 16) /* low bank register */ outl(1 << (offset + 16), chip->base + reg); else /* high bank register */ outl(1 << offset, chip->base + 0x80 + reg); } void cs5535_gpio_clear(unsigned offset, unsigned int reg) { struct cs5535_gpio_chip *chip = &cs5535_gpio_chip; unsigned long flags; spin_lock_irqsave(&chip->lock, flags); __cs5535_gpio_clear(chip, offset, reg); spin_unlock_irqrestore(&chip->lock, flags); } EXPORT_SYMBOL_GPL(cs5535_gpio_clear); int cs5535_gpio_isset(unsigned offset, unsigned int reg) { struct cs5535_gpio_chip *chip = &cs5535_gpio_chip; unsigned long flags; long val; spin_lock_irqsave(&chip->lock, flags); if (offset < 16) /* low bank register */ val = inl(chip->base + reg); else { /* high bank register */ val = inl(chip->base + 0x80 + reg); offset -= 16; } spin_unlock_irqrestore(&chip->lock, flags); return (val & (1 << offset)) ? 1 : 0; } EXPORT_SYMBOL_GPL(cs5535_gpio_isset); /* * Generic gpio_chip API support. */ static int chip_gpio_get(struct gpio_chip *chip, unsigned offset) { return cs5535_gpio_isset(offset, GPIO_OUTPUT_VAL); } static void chip_gpio_set(struct gpio_chip *chip, unsigned offset, int val) { if (val) cs5535_gpio_set(offset, GPIO_OUTPUT_VAL); else cs5535_gpio_clear(offset, GPIO_OUTPUT_VAL); } static int chip_direction_input(struct gpio_chip *c, unsigned offset) { struct cs5535_gpio_chip *chip = (struct cs5535_gpio_chip *) c; unsigned long flags; spin_lock_irqsave(&chip->lock, flags); __cs5535_gpio_set(chip, offset, GPIO_INPUT_ENABLE); spin_unlock_irqrestore(&chip->lock, flags); return 0; } static int chip_direction_output(struct gpio_chip *c, unsigned offset, int val) { struct cs5535_gpio_chip *chip = (struct cs5535_gpio_chip *) c; unsigned long flags; spin_lock_irqsave(&chip->lock, flags); __cs5535_gpio_set(chip, offset, GPIO_OUTPUT_ENABLE); if (val) __cs5535_gpio_set(chip, offset, GPIO_OUTPUT_VAL); else __cs5535_gpio_clear(chip, offset, GPIO_OUTPUT_VAL); spin_unlock_irqrestore(&chip->lock, flags); return 0; } static struct cs5535_gpio_chip cs5535_gpio_chip = { .chip = { .owner = THIS_MODULE, .label = DRV_NAME, .base = 0, .ngpio = 28, .get = chip_gpio_get, .set = chip_gpio_set, .direction_input = chip_direction_input, .direction_output = chip_direction_output, }, }; static int __init cs5535_gpio_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id) { int err; /* There are two ways to get the GPIO base address; one is by * fetching it from MSR_LBAR_GPIO, the other is by reading the * PCI BAR info. The latter method is easier (especially across * different architectures), so we'll stick with that for now. If * 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"); 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); goto done; } /* set up the driver-specific struct */ cs5535_gpio_chip.base = pci_resource_start(pdev, GPIO_BAR); 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); /* finally, register with the generic GPIO API */ err = gpiochip_add(&cs5535_gpio_chip.chip); if (err) { dev_err(&pdev->dev, "failed to register gpio chip\n"); goto release_region; } printk(KERN_INFO DRV_NAME ": GPIO support successfully loaded.\n"); return 0; release_region: pci_release_region(pdev, GPIO_BAR); done: return err; } static void __exit cs5535_gpio_remove(struct pci_dev *pdev) { 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); } static int __init cs5535_gpio_init(void) { return cs5535_gpio_scan_pci(); } static void __exit cs5535_gpio_exit(void) { cs5535_gpio_free_pci(); } module_init(cs5535_gpio_init); module_exit(cs5535_gpio_exit); MODULE_AUTHOR("Andres Salomon "); MODULE_DESCRIPTION("AMD CS5535/CS5536 GPIO driver"); MODULE_LICENSE("GPL");