gpio: ath79: Make the driver removable
[deliverable/linux.git] / drivers / gpio / gpio-ath79.c
CommitLineData
6eae43c5
GJ
1/*
2 * Atheros AR71XX/AR724X/AR913X GPIO API support
3 *
5b5b544e
GJ
4 * Copyright (C) 2010-2011 Jaiganesh Narayanan <jnarayanan@atheros.com>
5 * Copyright (C) 2008-2011 Gabor Juhos <juhosg@openwrt.org>
6eae43c5
GJ
6 * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
7 *
5b5b544e
GJ
8 * Parts of this file are based on Atheros' 2.6.15/2.6.31 BSP
9 *
6eae43c5
GJ
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License version 2 as published
12 * by the Free Software Foundation.
13 */
14
49a5bd88 15#include <linux/gpio/driver.h>
2ddf3a79
AB
16#include <linux/platform_data/gpio-ath79.h>
17#include <linux/of_device.h>
6eae43c5 18
409d8783
AB
19#define AR71XX_GPIO_REG_OE 0x00
20#define AR71XX_GPIO_REG_IN 0x04
21#define AR71XX_GPIO_REG_SET 0x0c
22#define AR71XX_GPIO_REG_CLEAR 0x10
6eae43c5 23
49a5bd88 24struct ath79_gpio_ctrl {
ab32770e 25 struct gpio_chip gc;
49a5bd88
AB
26 void __iomem *base;
27 spinlock_t lock;
28};
29
2ddf3a79
AB
30static const struct of_device_id ath79_gpio_of_match[] = {
31 { .compatible = "qca,ar7100-gpio" },
32 { .compatible = "qca,ar9340-gpio" },
33 {},
34};
35
36static int ath79_gpio_probe(struct platform_device *pdev)
6eae43c5 37{
ab128afc 38 struct ath79_gpio_platform_data *pdata = dev_get_platdata(&pdev->dev);
2ddf3a79 39 struct device_node *np = pdev->dev.of_node;
49a5bd88 40 struct ath79_gpio_ctrl *ctrl;
2ddf3a79 41 struct resource *res;
49a5bd88 42 u32 ath79_gpio_count;
2ddf3a79 43 bool oe_inverted;
6eae43c5
GJ
44 int err;
45
49a5bd88
AB
46 ctrl = devm_kzalloc(&pdev->dev, sizeof(*ctrl), GFP_KERNEL);
47 if (!ctrl)
48 return -ENOMEM;
2f890cf0 49 platform_set_drvdata(pdev, ctrl);
49a5bd88 50
2ddf3a79
AB
51 if (np) {
52 err = of_property_read_u32(np, "ngpios", &ath79_gpio_count);
53 if (err) {
54 dev_err(&pdev->dev, "ngpios property is not valid\n");
55 return err;
56 }
57 if (ath79_gpio_count >= 32) {
58 dev_err(&pdev->dev, "ngpios must be less than 32\n");
59 return -EINVAL;
60 }
61 oe_inverted = of_device_is_compatible(np, "qca,ar9340-gpio");
62 } else if (pdata) {
63 ath79_gpio_count = pdata->ngpios;
64 oe_inverted = pdata->oe_inverted;
65 } else {
66 dev_err(&pdev->dev, "No DT node or platform data found\n");
67 return -EINVAL;
68 }
69
70 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
49a5bd88 71 ctrl->base = devm_ioremap_nocache(
2ddf3a79 72 &pdev->dev, res->start, resource_size(res));
49a5bd88 73 if (!ctrl->base)
2ddf3a79 74 return -ENOMEM;
6eae43c5 75
49a5bd88 76 spin_lock_init(&ctrl->lock);
ab32770e
AB
77 err = bgpio_init(&ctrl->gc, &pdev->dev, 4,
78 ctrl->base + AR71XX_GPIO_REG_IN,
79 ctrl->base + AR71XX_GPIO_REG_SET,
80 ctrl->base + AR71XX_GPIO_REG_CLEAR,
81 oe_inverted ? NULL : ctrl->base + AR71XX_GPIO_REG_OE,
82 oe_inverted ? ctrl->base + AR71XX_GPIO_REG_OE : NULL,
83 0);
84 if (err) {
85 dev_err(&pdev->dev, "bgpio_init failed\n");
86 return err;
5b5b544e 87 }
ab32770e
AB
88 /* Use base 0 to stay compatible with legacy platforms */
89 ctrl->gc.base = 0;
6eae43c5 90
ab32770e 91 err = gpiochip_add_data(&ctrl->gc, ctrl);
2ddf3a79
AB
92 if (err) {
93 dev_err(&pdev->dev,
94 "cannot add AR71xx GPIO chip, error=%d", err);
95 return err;
96 }
97
98 return 0;
6eae43c5
GJ
99}
100
2f890cf0
AB
101static int ath79_gpio_remove(struct platform_device *pdev)
102{
103 struct ath79_gpio_ctrl *ctrl = platform_get_drvdata(pdev);
104
105 gpiochip_remove(&ctrl->gc);
106 return 0;
107}
108
2ddf3a79
AB
109static struct platform_driver ath79_gpio_driver = {
110 .driver = {
111 .name = "ath79-gpio",
112 .of_match_table = ath79_gpio_of_match,
113 },
114 .probe = ath79_gpio_probe,
2f890cf0 115 .remove = ath79_gpio_remove,
2ddf3a79
AB
116};
117
118module_platform_driver(ath79_gpio_driver);
This page took 0.424211 seconds and 5 git commands to generate.