1 // SPDX-License-Identifier: GPL-2.0+
3 * Freescale vf610 GPIO support through PORT and GPIO
5 * Copyright (c) 2014 Toradex AG.
7 * Author: Stefan Agner <stefan@agner.ch>.
9 #include <linux/bitops.h>
10 #include <linux/clk.h>
11 #include <linux/err.h>
12 #include <linux/gpio/driver.h>
13 #include <linux/init.h>
14 #include <linux/interrupt.h>
16 #include <linux/ioport.h>
17 #include <linux/irq.h>
18 #include <linux/platform_device.h>
20 #include <linux/of_device.h>
21 #include <linux/of_irq.h>
23 #define VF610_GPIO_PER_PORT 32
25 struct fsl_gpio_soc_data
{
26 /* SoCs has a Port Data Direction Register (PDDR) */
30 struct vf610_gpio_port
{
33 void __iomem
*gpio_base
;
34 const struct fsl_gpio_soc_data
*sdata
;
35 u8 irqc
[VF610_GPIO_PER_PORT
];
41 #define GPIO_PDOR 0x00
42 #define GPIO_PSOR 0x04
43 #define GPIO_PCOR 0x08
44 #define GPIO_PTOR 0x0c
45 #define GPIO_PDIR 0x10
46 #define GPIO_PDDR 0x14
48 #define PORT_PCR(n) ((n) * 0x4)
49 #define PORT_PCR_IRQC_OFFSET 16
51 #define PORT_ISFR 0xa0
52 #define PORT_DFER 0xc0
53 #define PORT_DFCR 0xc4
54 #define PORT_DFWR 0xc8
56 #define PORT_INT_OFF 0x0
57 #define PORT_INT_LOGIC_ZERO 0x8
58 #define PORT_INT_RISING_EDGE 0x9
59 #define PORT_INT_FALLING_EDGE 0xa
60 #define PORT_INT_EITHER_EDGE 0xb
61 #define PORT_INT_LOGIC_ONE 0xc
63 static struct irq_chip vf610_gpio_irq_chip
;
65 static const struct fsl_gpio_soc_data imx_data
= {
69 static const struct of_device_id vf610_gpio_dt_ids
[] = {
70 { .compatible
= "fsl,vf610-gpio", .data
= NULL
, },
71 { .compatible
= "fsl,imx7ulp-gpio", .data
= &imx_data
, },
75 static inline void vf610_gpio_writel(u32 val
, void __iomem
*reg
)
77 writel_relaxed(val
, reg
);
80 static inline u32
vf610_gpio_readl(void __iomem
*reg
)
82 return readl_relaxed(reg
);
85 static int vf610_gpio_get(struct gpio_chip
*gc
, unsigned int gpio
)
87 struct vf610_gpio_port
*port
= gpiochip_get_data(gc
);
88 unsigned long mask
= BIT(gpio
);
91 if (port
->sdata
&& port
->sdata
->have_paddr
) {
92 mask
&= vf610_gpio_readl(port
->gpio_base
+ GPIO_PDDR
);
93 addr
= mask
? port
->gpio_base
+ GPIO_PDOR
:
94 port
->gpio_base
+ GPIO_PDIR
;
95 return !!(vf610_gpio_readl(addr
) & BIT(gpio
));
97 return !!(vf610_gpio_readl(port
->gpio_base
+ GPIO_PDIR
)
102 static void vf610_gpio_set(struct gpio_chip
*gc
, unsigned int gpio
, int val
)
104 struct vf610_gpio_port
*port
= gpiochip_get_data(gc
);
105 unsigned long mask
= BIT(gpio
);
108 vf610_gpio_writel(mask
, port
->gpio_base
+ GPIO_PSOR
);
110 vf610_gpio_writel(mask
, port
->gpio_base
+ GPIO_PCOR
);
113 static int vf610_gpio_direction_input(struct gpio_chip
*chip
, unsigned gpio
)
115 struct vf610_gpio_port
*port
= gpiochip_get_data(chip
);
116 unsigned long mask
= BIT(gpio
);
119 if (port
->sdata
&& port
->sdata
->have_paddr
) {
120 val
= vf610_gpio_readl(port
->gpio_base
+ GPIO_PDDR
);
122 vf610_gpio_writel(val
, port
->gpio_base
+ GPIO_PDDR
);
125 return pinctrl_gpio_direction_input(chip
->base
+ gpio
);
128 static int vf610_gpio_direction_output(struct gpio_chip
*chip
, unsigned gpio
,
131 struct vf610_gpio_port
*port
= gpiochip_get_data(chip
);
132 unsigned long mask
= BIT(gpio
);
134 if (port
->sdata
&& port
->sdata
->have_paddr
)
135 vf610_gpio_writel(mask
, port
->gpio_base
+ GPIO_PDDR
);
137 vf610_gpio_set(chip
, gpio
, value
);
139 return pinctrl_gpio_direction_output(chip
->base
+ gpio
);
142 static void vf610_gpio_irq_handler(struct irq_desc
*desc
)
144 struct vf610_gpio_port
*port
=
145 gpiochip_get_data(irq_desc_get_handler_data(desc
));
146 struct irq_chip
*chip
= irq_desc_get_chip(desc
);
148 unsigned long irq_isfr
;
150 chained_irq_enter(chip
, desc
);
152 irq_isfr
= vf610_gpio_readl(port
->base
+ PORT_ISFR
);
154 for_each_set_bit(pin
, &irq_isfr
, VF610_GPIO_PER_PORT
) {
155 vf610_gpio_writel(BIT(pin
), port
->base
+ PORT_ISFR
);
157 generic_handle_irq(irq_find_mapping(port
->gc
.irq
.domain
, pin
));
160 chained_irq_exit(chip
, desc
);
163 static void vf610_gpio_irq_ack(struct irq_data
*d
)
165 struct vf610_gpio_port
*port
=
166 gpiochip_get_data(irq_data_get_irq_chip_data(d
));
169 vf610_gpio_writel(BIT(gpio
), port
->base
+ PORT_ISFR
);
172 static int vf610_gpio_irq_set_type(struct irq_data
*d
, u32 type
)
174 struct vf610_gpio_port
*port
=
175 gpiochip_get_data(irq_data_get_irq_chip_data(d
));
179 case IRQ_TYPE_EDGE_RISING
:
180 irqc
= PORT_INT_RISING_EDGE
;
182 case IRQ_TYPE_EDGE_FALLING
:
183 irqc
= PORT_INT_FALLING_EDGE
;
185 case IRQ_TYPE_EDGE_BOTH
:
186 irqc
= PORT_INT_EITHER_EDGE
;
188 case IRQ_TYPE_LEVEL_LOW
:
189 irqc
= PORT_INT_LOGIC_ZERO
;
191 case IRQ_TYPE_LEVEL_HIGH
:
192 irqc
= PORT_INT_LOGIC_ONE
;
198 port
->irqc
[d
->hwirq
] = irqc
;
200 if (type
& IRQ_TYPE_LEVEL_MASK
)
201 irq_set_handler_locked(d
, handle_level_irq
);
203 irq_set_handler_locked(d
, handle_edge_irq
);
208 static void vf610_gpio_irq_mask(struct irq_data
*d
)
210 struct vf610_gpio_port
*port
=
211 gpiochip_get_data(irq_data_get_irq_chip_data(d
));
212 void __iomem
*pcr_base
= port
->base
+ PORT_PCR(d
->hwirq
);
214 vf610_gpio_writel(0, pcr_base
);
217 static void vf610_gpio_irq_unmask(struct irq_data
*d
)
219 struct vf610_gpio_port
*port
=
220 gpiochip_get_data(irq_data_get_irq_chip_data(d
));
221 void __iomem
*pcr_base
= port
->base
+ PORT_PCR(d
->hwirq
);
223 vf610_gpio_writel(port
->irqc
[d
->hwirq
] << PORT_PCR_IRQC_OFFSET
,
227 static int vf610_gpio_irq_set_wake(struct irq_data
*d
, u32 enable
)
229 struct vf610_gpio_port
*port
=
230 gpiochip_get_data(irq_data_get_irq_chip_data(d
));
233 enable_irq_wake(port
->irq
);
235 disable_irq_wake(port
->irq
);
240 static struct irq_chip vf610_gpio_irq_chip
= {
241 .name
= "gpio-vf610",
242 .irq_ack
= vf610_gpio_irq_ack
,
243 .irq_mask
= vf610_gpio_irq_mask
,
244 .irq_unmask
= vf610_gpio_irq_unmask
,
245 .irq_set_type
= vf610_gpio_irq_set_type
,
246 .irq_set_wake
= vf610_gpio_irq_set_wake
,
249 static int vf610_gpio_probe(struct platform_device
*pdev
)
251 struct device
*dev
= &pdev
->dev
;
252 struct device_node
*np
= dev
->of_node
;
253 struct vf610_gpio_port
*port
;
254 struct resource
*iores
;
255 struct gpio_chip
*gc
;
259 port
= devm_kzalloc(&pdev
->dev
, sizeof(*port
), GFP_KERNEL
);
263 port
->sdata
= of_device_get_match_data(dev
);
264 iores
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
265 port
->base
= devm_ioremap_resource(dev
, iores
);
266 if (IS_ERR(port
->base
))
267 return PTR_ERR(port
->base
);
269 iores
= platform_get_resource(pdev
, IORESOURCE_MEM
, 1);
270 port
->gpio_base
= devm_ioremap_resource(dev
, iores
);
271 if (IS_ERR(port
->gpio_base
))
272 return PTR_ERR(port
->gpio_base
);
274 port
->irq
= platform_get_irq(pdev
, 0);
278 port
->clk_port
= devm_clk_get(&pdev
->dev
, "port");
279 if (!IS_ERR(port
->clk_port
)) {
280 ret
= clk_prepare_enable(port
->clk_port
);
283 } else if (port
->clk_port
== ERR_PTR(-EPROBE_DEFER
)) {
285 * Percolate deferrals, for anything else,
286 * just live without the clocking.
288 return PTR_ERR(port
->clk_port
);
291 port
->clk_gpio
= devm_clk_get(&pdev
->dev
, "gpio");
292 if (!IS_ERR(port
->clk_gpio
)) {
293 ret
= clk_prepare_enable(port
->clk_gpio
);
295 clk_disable_unprepare(port
->clk_port
);
298 } else if (port
->clk_gpio
== ERR_PTR(-EPROBE_DEFER
)) {
299 clk_disable_unprepare(port
->clk_port
);
300 return PTR_ERR(port
->clk_gpio
);
303 platform_set_drvdata(pdev
, port
);
308 gc
->label
= "vf610-gpio";
309 gc
->ngpio
= VF610_GPIO_PER_PORT
;
310 gc
->base
= of_alias_get_id(np
, "gpio") * VF610_GPIO_PER_PORT
;
312 gc
->request
= gpiochip_generic_request
;
313 gc
->free
= gpiochip_generic_free
;
314 gc
->direction_input
= vf610_gpio_direction_input
;
315 gc
->get
= vf610_gpio_get
;
316 gc
->direction_output
= vf610_gpio_direction_output
;
317 gc
->set
= vf610_gpio_set
;
319 ret
= gpiochip_add_data(gc
, port
);
323 /* Mask all GPIO interrupts */
324 for (i
= 0; i
< gc
->ngpio
; i
++)
325 vf610_gpio_writel(0, port
->base
+ PORT_PCR(i
));
327 /* Clear the interrupt status register for all GPIO's */
328 vf610_gpio_writel(~0, port
->base
+ PORT_ISFR
);
330 ret
= gpiochip_irqchip_add(gc
, &vf610_gpio_irq_chip
, 0,
331 handle_edge_irq
, IRQ_TYPE_NONE
);
333 dev_err(dev
, "failed to add irqchip\n");
337 gpiochip_set_chained_irqchip(gc
, &vf610_gpio_irq_chip
, port
->irq
,
338 vf610_gpio_irq_handler
);
343 static int vf610_gpio_remove(struct platform_device
*pdev
)
345 struct vf610_gpio_port
*port
= platform_get_drvdata(pdev
);
347 gpiochip_remove(&port
->gc
);
348 if (!IS_ERR(port
->clk_port
))
349 clk_disable_unprepare(port
->clk_port
);
350 if (!IS_ERR(port
->clk_gpio
))
351 clk_disable_unprepare(port
->clk_gpio
);
356 static struct platform_driver vf610_gpio_driver
= {
358 .name
= "gpio-vf610",
359 .of_match_table
= vf610_gpio_dt_ids
,
361 .probe
= vf610_gpio_probe
,
362 .remove
= vf610_gpio_remove
,
365 builtin_platform_driver(vf610_gpio_driver
);