| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165 |
- From dbe94a8daaa63ef81b7414f2a17bca8e36dd6daa Mon Sep 17 00:00:00 2001
- From: Jonas Gorski <jogo@openwrt.org>
- Date: Fri, 20 Feb 2015 19:55:32 +0100
- Subject: [PATCH 1/6] gpio: add a simple GPIO driver for bcm63xx
- Signed-off-by: Jonas Gorski <jogo@openwrt.org>
- ---
- drivers/gpio/Kconfig | 8 +++
- drivers/gpio/Makefile | 1 +
- drivers/gpio/gpio-bcm63xx.c | 122 +++++++++++++++++++++++++++++++++++++++++++
- 3 files changed, 131 insertions(+)
- create mode 100644 drivers/gpio/gpio-bcm63xx.c
- --- a/drivers/gpio/Kconfig
- +++ b/drivers/gpio/Kconfig
- @@ -132,6 +132,13 @@ config GPIO_BCM_KONA
- help
- Turn on GPIO support for Broadcom "Kona" chips.
-
- +config GPIO_BCM63XX
- + bool "Broadcom BCM63XX GPIO"
- + depends on MIPS || COMPILE_TEST
- + select GPIO_GENERIC
- + help
- + Turn on GPIO support for Broadcom BCM63XX xDSL chips.
- +
- config GPIO_BRCMSTB
- tristate "BRCMSTB GPIO support"
- default y if ARCH_BRCMSTB
- --- a/drivers/gpio/Makefile
- +++ b/drivers/gpio/Makefile
- @@ -24,6 +24,7 @@ obj-$(CONFIG_GPIO_AMDPT) += gpio-amdpt.o
- obj-$(CONFIG_GPIO_ARIZONA) += gpio-arizona.o
- obj-$(CONFIG_ATH79) += gpio-ath79.o
- obj-$(CONFIG_GPIO_BCM_KONA) += gpio-bcm-kona.o
- +obj-$(CONFIG_GPIO_BCM63XX) += gpio-bcm63xx.o
- obj-$(CONFIG_GPIO_BRCMSTB) += gpio-brcmstb.o
- obj-$(CONFIG_GPIO_BT8XX) += gpio-bt8xx.o
- obj-$(CONFIG_GPIO_CLPS711X) += gpio-clps711x.o
- --- /dev/null
- +++ b/drivers/gpio/gpio-bcm63xx.c
- @@ -0,0 +1,122 @@
- +/*
- + * Driver for BCM63XX memory-mapped GPIO controllers, based on
- + * Generic driver for memory-mapped GPIO controllers.
- + *
- + * Copyright 2008 MontaVista Software, Inc.
- + * Copyright 2008,2010 Anton Vorontsov <cbouatmailru@gmail.com>
- + * Copyright 2015 Jonas Gorski <jogo@openwrt.org>
- + *
- + * This program is free software; you can redistribute it and/or modify it
- + * under the terms of the GNU General Public License as published by the
- + * Free Software Foundation; either version 2 of the License, or (at your
- + * option) any later version.
- + */
- +
- +#include <linux/init.h>
- +#include <linux/err.h>
- +#include <linux/bug.h>
- +#include <linux/kernel.h>
- +#include <linux/module.h>
- +#include <linux/spinlock.h>
- +#include <linux/compiler.h>
- +#include <linux/types.h>
- +#include <linux/errno.h>
- +#include <linux/log2.h>
- +#include <linux/ioport.h>
- +#include <linux/io.h>
- +#include <linux/gpio.h>
- +#include <linux/slab.h>
- +#include <linux/platform_device.h>
- +#include <linux/mod_devicetable.h>
- +#include <linux/basic_mmio_gpio.h>
- +#include <linux/of.h>
- +#include <linux/of_gpio.h>
- +
- +static int bcm63xx_gpio_probe(struct platform_device *pdev)
- +{
- + struct device *dev = &pdev->dev;
- + struct resource *dat_r, *dirout_r;
- + void __iomem *dat;
- + void __iomem *dirout;
- + unsigned long sz;
- + int err;
- + struct bgpio_chip *bgc;
- + struct bgpio_pdata *pdata = dev_get_platdata(dev);
- +
- + dirout_r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- + dat_r = platform_get_resource(pdev, IORESOURCE_MEM, 1);
- + if (!dat_r || !dirout_r)
- + return -EINVAL;
- +
- + if (resource_size(dat_r) != resource_size(dirout_r))
- + return -EINVAL;
- +
- + sz = resource_size(dat_r);
- +
- + dat = devm_ioremap_resource(dev, dat_r);
- + if (IS_ERR(dat))
- + return PTR_ERR(dat);
- +
- + dirout = devm_ioremap_resource(dev, dirout_r);
- + if (IS_ERR(dirout))
- + return PTR_ERR(dirout);
- +
- + bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL);
- + if (!bgc)
- + return -ENOMEM;
- +
- + err = bgpio_init(bgc, dev, sz, dat, NULL, NULL, dirout, NULL,
- + BGPIOF_BIG_ENDIAN_BYTE_ORDER);
- + if (err)
- + return err;
- +
- + platform_set_drvdata(pdev, bgc);
- +
- + if (dev->of_node) {
- + int id = of_alias_get_id(dev->of_node, "gpio");
- + u32 ngpios;
- +
- + if (id >= 0)
- + bgc->gc.label = devm_kasprintf(dev, GFP_KERNEL,
- + "bcm63xx-gpio.%d", id);
- +
- + if (!of_property_read_u32(dev->of_node, "ngpios", &ngpios))
- + bgc->gc.ngpio = ngpios;
- +
- + } else if (pdata) {
- + bgc->gc.base = pdata->base;
- + if (pdata->ngpio > 0)
- + bgc->gc.ngpio = pdata->ngpio;
- + }
- +
- + return gpiochip_add(&bgc->gc);
- +}
- +
- +static int bcm63xx_gpio_remove(struct platform_device *pdev)
- +{
- + struct bgpio_chip *bgc = platform_get_drvdata(pdev);
- +
- + return bgpio_remove(bgc);
- +}
- +
- +#ifdef CONFIG_OF
- +static struct of_device_id bcm63xx_gpio_of_match[] = {
- + { .compatible = "brcm,bcm6345-gpio" },
- + { },
- +};
- +#endif
- +
- +static struct platform_driver bcm63xx_gpio_driver = {
- + .probe = bcm63xx_gpio_probe,
- + .remove = bcm63xx_gpio_remove,
- + .driver = {
- + .name = "bcm63xx-gpio",
- + .of_match_table = of_match_ptr(bcm63xx_gpio_of_match),
- + },
- +};
- +
- +module_platform_driver(bcm63xx_gpio_driver);
- +
- +MODULE_DESCRIPTION("Driver for BCM63XX memory-mapped GPIO controllers");
- +MODULE_AUTHOR("Jonas Gorski <jogo@openwrt.org>");
- +MODULE_LICENSE("GPL");
|
