LXR linux/drivers/gpio/gpio-clps711x.c

   1/*
   2 *  CLPS711X GPIO driver
   3 *
   4 *  Copyright (C) 2012,2013 Alexander Shiyan <shc_work@mail.ru>
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License as published by
   8 * the Free Software Foundation; either version 2 of the License, or
   9 * (at your option) any later version.
  10 */
  11
  12#include <linux/err.h>
  13#include <linux/gpio.h>
  14#include <linux/module.h>
  15#include <linux/basic_mmio_gpio.h>
  16#include <linux/platform_device.h>
  17
  18static int clps711x_gpio_probe(struct platform_device *pdev)
  19{
  20        struct device_node *np = pdev->dev.of_node;
  21        void __iomem *dat, *dir;
  22        struct bgpio_chip *bgc;
  23        struct resource *res;
  24        int err, id = np ? of_alias_get_id(np, "gpio") : pdev->id;
  25
  26        if ((id < 0) || (id > 4))
  27                return -ENODEV;
  28
  29        bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL);
  30        if (!bgc)
  31                return -ENOMEM;
  32
  33        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  34        dat = devm_ioremap_resource(&pdev->dev, res);
  35        if (IS_ERR(dat))
  36                return PTR_ERR(dat);
  37
  38        res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  39        dir = devm_ioremap_resource(&pdev->dev, res);
  40        if (IS_ERR(dir))
  41                return PTR_ERR(dir);
  42
  43        switch (id) {
  44        case 3:
  45                /* PORTD is inverted logic for direction register */
  46                err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
  47                                 NULL, dir, 0);
  48                break;
  49        default:
  50                err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
  51                                 dir, NULL, 0);
  52                break;
  53        }
  54
  55        if (err)
  56                return err;
  57
  58        switch (id) {
  59        case 4:
  60                /* PORTE is 3 lines only */
  61                bgc->gc.ngpio = 3;
  62                break;
  63        default:
  64                break;
  65        }
  66
  67        bgc->gc.base = id * 8;
  68        bgc->gc.owner = THIS_MODULE;
  69        platform_set_drvdata(pdev, bgc);
  70
  71        return gpiochip_add(&bgc->gc);
  72}
  73
  74static int clps711x_gpio_remove(struct platform_device *pdev)
  75{
  76        struct bgpio_chip *bgc = platform_get_drvdata(pdev);
  77
  78        return bgpio_remove(bgc);
  79}
  80
  81static const struct of_device_id __maybe_unused clps711x_gpio_ids[] = {
  82        { .compatible = "cirrus,clps711x-gpio" },
  83        { }
  84};
  85MODULE_DEVICE_TABLE(of, clps711x_gpio_ids);
  86
  87static struct platform_driver clps711x_gpio_driver = {
  88        .driver = {
  89                .name           = "clps711x-gpio",
  90                .of_match_table = of_match_ptr(clps711x_gpio_ids),
  91        },
  92        .probe  = clps711x_gpio_probe,
  93        .remove = clps711x_gpio_remove,
  94};
  95module_platform_driver(clps711x_gpio_driver);
  96
  97MODULE_LICENSE("GPL");
  98MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
  99MODULE_DESCRIPTION("CLPS711X GPIO driver");
 100MODULE_ALIAS("platform:clps711x-gpio");
 101