Commit | Line | Data |
---|---|---|
b2b35e10 V |
1 | /* |
2 | * AppliedMicro X-Gene SoC GPIO-Standby Driver | |
3 | * | |
4 | * Copyright (c) 2014, Applied Micro Circuits Corporation | |
5 | * Author: Tin Huynh <tnhuynh@apm.com>. | |
6 | * Y Vo <yvo@apm.com>. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify it | |
9 | * under the terms of the GNU General Public License as published by the | |
10 | * Free Software Foundation; either version 2 of the License, or (at your | |
11 | * option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
20 | */ | |
21 | ||
22 | #include <linux/module.h> | |
23 | #include <linux/io.h> | |
24 | #include <linux/platform_device.h> | |
25 | #include <linux/of_gpio.h> | |
b2b35e10 | 26 | #include <linux/gpio/driver.h> |
733cf014 | 27 | #include <linux/acpi.h> |
b2b35e10 | 28 | |
733cf014 V |
29 | #include "gpiolib.h" |
30 | ||
b2b35e10 V |
31 | #define XGENE_MAX_GPIO_DS 22 |
32 | #define XGENE_MAX_GPIO_DS_IRQ 6 | |
33 | ||
34 | #define GPIO_MASK(x) (1U << ((x) % 32)) | |
35 | ||
36 | #define MPA_GPIO_INT_LVL 0x0290 | |
37 | #define MPA_GPIO_OE_ADDR 0x029c | |
38 | #define MPA_GPIO_OUT_ADDR 0x02a0 | |
39 | #define MPA_GPIO_IN_ADDR 0x02a4 | |
40 | #define MPA_GPIO_SEL_LO 0x0294 | |
41 | ||
42 | /** | |
43 | * struct xgene_gpio_sb - GPIO-Standby private data structure. | |
0f4630f3 | 44 | * @gc: memory-mapped GPIO controllers. |
b2b35e10 V |
45 | * @irq: Mapping GPIO pins and interrupt number |
46 | * nirq: Number of GPIO pins that supports interrupt | |
47 | */ | |
48 | struct xgene_gpio_sb { | |
0f4630f3 | 49 | struct gpio_chip gc; |
b2b35e10 V |
50 | u32 *irq; |
51 | u32 nirq; | |
52 | }; | |
53 | ||
0f4630f3 | 54 | static void xgene_gpio_set_bit(struct gpio_chip *gc, void __iomem *reg, u32 gpio, int val) |
b2b35e10 V |
55 | { |
56 | u32 data; | |
57 | ||
0f4630f3 | 58 | data = gc->read_reg(reg); |
b2b35e10 V |
59 | if (val) |
60 | data |= GPIO_MASK(gpio); | |
61 | else | |
62 | data &= ~GPIO_MASK(gpio); | |
0f4630f3 | 63 | gc->write_reg(reg, data); |
b2b35e10 V |
64 | } |
65 | ||
66 | static int apm_gpio_sb_to_irq(struct gpio_chip *gc, u32 gpio) | |
67 | { | |
0f4630f3 | 68 | struct xgene_gpio_sb *priv = gpiochip_get_data(gc); |
b2b35e10 V |
69 | |
70 | if (priv->irq[gpio]) | |
71 | return priv->irq[gpio]; | |
72 | ||
73 | return -ENXIO; | |
74 | } | |
75 | ||
76 | static int xgene_gpio_sb_probe(struct platform_device *pdev) | |
77 | { | |
78 | struct xgene_gpio_sb *priv; | |
79 | u32 ret, i; | |
80 | u32 default_lines[] = {0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D}; | |
81 | struct resource *res; | |
82 | void __iomem *regs; | |
83 | ||
84 | priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); | |
85 | if (!priv) | |
86 | return -ENOMEM; | |
87 | ||
88 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
89 | regs = devm_ioremap_resource(&pdev->dev, res); | |
33c07b46 | 90 | if (IS_ERR(regs)) |
b2b35e10 V |
91 | return PTR_ERR(regs); |
92 | ||
0f4630f3 | 93 | ret = bgpio_init(&priv->gc, &pdev->dev, 4, |
b2b35e10 V |
94 | regs + MPA_GPIO_IN_ADDR, |
95 | regs + MPA_GPIO_OUT_ADDR, NULL, | |
96 | regs + MPA_GPIO_OE_ADDR, NULL, 0); | |
97 | if (ret) | |
98 | return ret; | |
99 | ||
0f4630f3 LW |
100 | priv->gc.to_irq = apm_gpio_sb_to_irq; |
101 | priv->gc.ngpio = XGENE_MAX_GPIO_DS; | |
b2b35e10 V |
102 | |
103 | priv->nirq = XGENE_MAX_GPIO_DS_IRQ; | |
104 | ||
105 | priv->irq = devm_kzalloc(&pdev->dev, sizeof(u32) * XGENE_MAX_GPIO_DS, | |
106 | GFP_KERNEL); | |
107 | if (!priv->irq) | |
108 | return -ENOMEM; | |
b2b35e10 V |
109 | |
110 | for (i = 0; i < priv->nirq; i++) { | |
111 | priv->irq[default_lines[i]] = platform_get_irq(pdev, i); | |
0f4630f3 | 112 | xgene_gpio_set_bit(&priv->gc, regs + MPA_GPIO_SEL_LO, |
b2b35e10 | 113 | default_lines[i] * 2, 1); |
0f4630f3 | 114 | xgene_gpio_set_bit(&priv->gc, regs + MPA_GPIO_INT_LVL, i, 1); |
b2b35e10 V |
115 | } |
116 | ||
117 | platform_set_drvdata(pdev, priv); | |
118 | ||
0f4630f3 | 119 | ret = gpiochip_add_data(&priv->gc, priv); |
b2b35e10 V |
120 | if (ret) |
121 | dev_err(&pdev->dev, "failed to register X-Gene GPIO Standby driver\n"); | |
122 | else | |
123 | dev_info(&pdev->dev, "X-Gene GPIO Standby driver registered\n"); | |
124 | ||
733cf014 V |
125 | if (priv->nirq > 0) { |
126 | /* Register interrupt handlers for gpio signaled acpi events */ | |
0f4630f3 | 127 | acpi_gpiochip_request_interrupts(&priv->gc); |
733cf014 V |
128 | } |
129 | ||
b2b35e10 V |
130 | return ret; |
131 | } | |
132 | ||
133 | static int xgene_gpio_sb_remove(struct platform_device *pdev) | |
134 | { | |
135 | struct xgene_gpio_sb *priv = platform_get_drvdata(pdev); | |
136 | ||
733cf014 | 137 | if (priv->nirq > 0) { |
0f4630f3 | 138 | acpi_gpiochip_free_interrupts(&priv->gc); |
733cf014 V |
139 | } |
140 | ||
0f4630f3 LW |
141 | gpiochip_remove(&priv->gc); |
142 | return 0; | |
b2b35e10 V |
143 | } |
144 | ||
145 | static const struct of_device_id xgene_gpio_sb_of_match[] = { | |
146 | {.compatible = "apm,xgene-gpio-sb", }, | |
147 | {}, | |
148 | }; | |
149 | MODULE_DEVICE_TABLE(of, xgene_gpio_sb_of_match); | |
150 | ||
733cf014 V |
151 | #ifdef CONFIG_ACPI |
152 | static const struct acpi_device_id xgene_gpio_sb_acpi_match[] = { | |
153 | {"APMC0D15", 0}, | |
154 | {}, | |
155 | }; | |
156 | MODULE_DEVICE_TABLE(acpi, xgene_gpio_sb_acpi_match); | |
157 | #endif | |
158 | ||
b2b35e10 V |
159 | static struct platform_driver xgene_gpio_sb_driver = { |
160 | .driver = { | |
161 | .name = "xgene-gpio-sb", | |
162 | .of_match_table = xgene_gpio_sb_of_match, | |
733cf014 | 163 | .acpi_match_table = ACPI_PTR(xgene_gpio_sb_acpi_match), |
b2b35e10 V |
164 | }, |
165 | .probe = xgene_gpio_sb_probe, | |
166 | .remove = xgene_gpio_sb_remove, | |
167 | }; | |
168 | module_platform_driver(xgene_gpio_sb_driver); | |
169 | ||
170 | MODULE_AUTHOR("AppliedMicro"); | |
171 | MODULE_DESCRIPTION("APM X-Gene GPIO Standby driver"); | |
172 | MODULE_LICENSE("GPL"); |