Linux Audio

Check our new training course

Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2011 Jamie Iles
  4 *
 
 
 
 
  5 * All enquiries to support@picochip.com
  6 */
  7#include <linux/acpi.h>
  8#include <linux/clk.h>
  9#include <linux/err.h>
 10#include <linux/gpio/driver.h>
 11#include <linux/init.h>
 12#include <linux/interrupt.h>
 13#include <linux/io.h>
 14#include <linux/ioport.h>
 15#include <linux/irq.h>
 16#include <linux/mod_devicetable.h>
 17#include <linux/module.h>
 
 
 
 18#include <linux/platform_device.h>
 19#include <linux/property.h>
 20#include <linux/reset.h>
 21#include <linux/slab.h>
 22#include <linux/spinlock.h>
 23
 24#include "gpiolib-acpi.h"
 25
 26#define GPIO_SWPORTA_DR		0x00
 27#define GPIO_SWPORTA_DDR	0x04
 28#define GPIO_SWPORTB_DR		0x0c
 29#define GPIO_SWPORTB_DDR	0x10
 30#define GPIO_SWPORTC_DR		0x18
 31#define GPIO_SWPORTC_DDR	0x1c
 32#define GPIO_SWPORTD_DR		0x24
 33#define GPIO_SWPORTD_DDR	0x28
 34#define GPIO_INTEN		0x30
 35#define GPIO_INTMASK		0x34
 36#define GPIO_INTTYPE_LEVEL	0x38
 37#define GPIO_INT_POLARITY	0x3c
 38#define GPIO_INTSTATUS		0x40
 39#define GPIO_PORTA_DEBOUNCE	0x48
 40#define GPIO_PORTA_EOI		0x4c
 41#define GPIO_EXT_PORTA		0x50
 42#define GPIO_EXT_PORTB		0x54
 43#define GPIO_EXT_PORTC		0x58
 44#define GPIO_EXT_PORTD		0x5c
 45
 46#define DWAPB_DRIVER_NAME	"gpio-dwapb"
 47#define DWAPB_MAX_PORTS		4
 48#define DWAPB_MAX_GPIOS		32
 49
 50#define GPIO_EXT_PORT_STRIDE	0x04 /* register stride 32 bits */
 51#define GPIO_SWPORT_DR_STRIDE	0x0c /* register stride 3*32 bits */
 52#define GPIO_SWPORT_DDR_STRIDE	0x0c /* register stride 3*32 bits */
 53
 54#define GPIO_REG_OFFSET_V1	0
 55#define GPIO_REG_OFFSET_V2	1
 56#define GPIO_REG_OFFSET_MASK	BIT(0)
 57
 58#define GPIO_INTMASK_V2		0x44
 59#define GPIO_INTTYPE_LEVEL_V2	0x34
 60#define GPIO_INT_POLARITY_V2	0x38
 61#define GPIO_INTSTATUS_V2	0x3c
 62#define GPIO_PORTA_EOI_V2	0x40
 63
 64#define DWAPB_NR_CLOCKS		2
 65
 66struct dwapb_gpio;
 67
 68struct dwapb_port_property {
 69	struct fwnode_handle *fwnode;
 70	unsigned int idx;
 71	unsigned int ngpio;
 72	unsigned int gpio_base;
 73	int irq[DWAPB_MAX_GPIOS];
 74};
 75
 76struct dwapb_platform_data {
 77	struct dwapb_port_property *properties;
 78	unsigned int nports;
 79};
 80
 81#ifdef CONFIG_PM_SLEEP
 82/* Store GPIO context across system-wide suspend/resume transitions */
 83struct dwapb_context {
 84	u32 data;
 85	u32 dir;
 86	u32 ext;
 87	u32 int_en;
 88	u32 int_mask;
 89	u32 int_type;
 90	u32 int_pol;
 91	u32 int_deb;
 92	u32 wake_en;
 93};
 94#endif
 95
 96struct dwapb_gpio_port_irqchip {
 97	unsigned int		nr_irqs;
 98	unsigned int		irq[DWAPB_MAX_GPIOS];
 99};
100
101struct dwapb_gpio_port {
102	struct gpio_chip	gc;
103	struct dwapb_gpio_port_irqchip *pirq;
104	struct dwapb_gpio	*gpio;
105#ifdef CONFIG_PM_SLEEP
106	struct dwapb_context	*ctx;
107#endif
108	unsigned int		idx;
109};
110#define to_dwapb_gpio(_gc) \
111	(container_of(_gc, struct dwapb_gpio_port, gc)->gpio)
112
113struct dwapb_gpio {
114	struct	device		*dev;
115	void __iomem		*regs;
116	struct dwapb_gpio_port	*ports;
117	unsigned int		nr_ports;
118	unsigned int		flags;
119	struct reset_control	*rst;
120	struct clk_bulk_data	clks[DWAPB_NR_CLOCKS];
121};
122
123static inline u32 gpio_reg_v2_convert(unsigned int offset)
124{
125	switch (offset) {
126	case GPIO_INTMASK:
127		return GPIO_INTMASK_V2;
128	case GPIO_INTTYPE_LEVEL:
129		return GPIO_INTTYPE_LEVEL_V2;
130	case GPIO_INT_POLARITY:
131		return GPIO_INT_POLARITY_V2;
132	case GPIO_INTSTATUS:
133		return GPIO_INTSTATUS_V2;
134	case GPIO_PORTA_EOI:
135		return GPIO_PORTA_EOI_V2;
136	}
137
138	return offset;
139}
140
141static inline u32 gpio_reg_convert(struct dwapb_gpio *gpio, unsigned int offset)
142{
143	if ((gpio->flags & GPIO_REG_OFFSET_MASK) == GPIO_REG_OFFSET_V2)
144		return gpio_reg_v2_convert(offset);
145
146	return offset;
147}
148
149static inline u32 dwapb_read(struct dwapb_gpio *gpio, unsigned int offset)
150{
151	struct gpio_chip *gc	= &gpio->ports[0].gc;
152	void __iomem *reg_base	= gpio->regs;
153
154	return gc->read_reg(reg_base + gpio_reg_convert(gpio, offset));
155}
156
157static inline void dwapb_write(struct dwapb_gpio *gpio, unsigned int offset,
158			       u32 val)
159{
160	struct gpio_chip *gc	= &gpio->ports[0].gc;
161	void __iomem *reg_base	= gpio->regs;
162
163	gc->write_reg(reg_base + gpio_reg_convert(gpio, offset), val);
164}
165
166static struct dwapb_gpio_port *dwapb_offs_to_port(struct dwapb_gpio *gpio, unsigned int offs)
167{
168	struct dwapb_gpio_port *port;
169	int i;
170
171	for (i = 0; i < gpio->nr_ports; i++) {
172		port = &gpio->ports[i];
173		if (port->idx == offs / DWAPB_MAX_GPIOS)
174			return port;
175	}
176
177	return NULL;
178}
179
180static void dwapb_toggle_trigger(struct dwapb_gpio *gpio, unsigned int offs)
181{
182	struct dwapb_gpio_port *port = dwapb_offs_to_port(gpio, offs);
183	struct gpio_chip *gc;
184	u32 pol;
185	int val;
186
187	if (!port)
188		return;
189	gc = &port->gc;
190
191	pol = dwapb_read(gpio, GPIO_INT_POLARITY);
192	/* Just read the current value right out of the data register */
193	val = gc->get(gc, offs % DWAPB_MAX_GPIOS);
194	if (val)
195		pol &= ~BIT(offs);
196	else
197		pol |= BIT(offs);
198
199	dwapb_write(gpio, GPIO_INT_POLARITY, pol);
200}
201
202static u32 dwapb_do_irq(struct dwapb_gpio *gpio)
203{
204	struct gpio_chip *gc = &gpio->ports[0].gc;
205	unsigned long irq_status;
206	irq_hw_number_t hwirq;
207
208	irq_status = dwapb_read(gpio, GPIO_INTSTATUS);
209	for_each_set_bit(hwirq, &irq_status, DWAPB_MAX_GPIOS) {
210		int gpio_irq = irq_find_mapping(gc->irq.domain, hwirq);
211		u32 irq_type = irq_get_trigger_type(gpio_irq);
212
213		generic_handle_irq(gpio_irq);
 
214
215		if ((irq_type & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH)
 
216			dwapb_toggle_trigger(gpio, hwirq);
217	}
218
219	return irq_status;
220}
221
222static void dwapb_irq_handler(struct irq_desc *desc)
223{
224	struct dwapb_gpio *gpio = irq_desc_get_handler_data(desc);
225	struct irq_chip *chip = irq_desc_get_chip(desc);
226
227	chained_irq_enter(chip, desc);
228	dwapb_do_irq(gpio);
229	chained_irq_exit(chip, desc);
230}
231
232static irqreturn_t dwapb_irq_handler_mfd(int irq, void *dev_id)
233{
234	return IRQ_RETVAL(dwapb_do_irq(dev_id));
235}
236
237static void dwapb_irq_ack(struct irq_data *d)
238{
239	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
240	struct dwapb_gpio *gpio = to_dwapb_gpio(gc);
241	u32 val = BIT(irqd_to_hwirq(d));
242	unsigned long flags;
243
244	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
245	dwapb_write(gpio, GPIO_PORTA_EOI, val);
246	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
247}
248
249static void dwapb_irq_mask(struct irq_data *d)
250{
251	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
252	struct dwapb_gpio *gpio = to_dwapb_gpio(gc);
253	irq_hw_number_t hwirq = irqd_to_hwirq(d);
254	unsigned long flags;
255	u32 val;
256
257	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
258	val = dwapb_read(gpio, GPIO_INTMASK) | BIT(hwirq);
259	dwapb_write(gpio, GPIO_INTMASK, val);
260	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
261
262	gpiochip_disable_irq(gc, hwirq);
263}
264
265static void dwapb_irq_unmask(struct irq_data *d)
266{
267	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
268	struct dwapb_gpio *gpio = to_dwapb_gpio(gc);
269	irq_hw_number_t hwirq = irqd_to_hwirq(d);
270	unsigned long flags;
271	u32 val;
272
273	gpiochip_enable_irq(gc, hwirq);
274
275	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
276	val = dwapb_read(gpio, GPIO_INTMASK) & ~BIT(hwirq);
277	dwapb_write(gpio, GPIO_INTMASK, val);
278	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
279}
280
281static void dwapb_irq_enable(struct irq_data *d)
282{
283	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
284	struct dwapb_gpio *gpio = to_dwapb_gpio(gc);
285	irq_hw_number_t hwirq = irqd_to_hwirq(d);
286	unsigned long flags;
287	u32 val;
288
289	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
290	val = dwapb_read(gpio, GPIO_INTEN) | BIT(hwirq);
291	dwapb_write(gpio, GPIO_INTEN, val);
292	val = dwapb_read(gpio, GPIO_INTMASK) & ~BIT(hwirq);
293	dwapb_write(gpio, GPIO_INTMASK, val);
294	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
295}
296
297static void dwapb_irq_disable(struct irq_data *d)
298{
299	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
300	struct dwapb_gpio *gpio = to_dwapb_gpio(gc);
301	irq_hw_number_t hwirq = irqd_to_hwirq(d);
302	unsigned long flags;
303	u32 val;
304
305	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
306	val = dwapb_read(gpio, GPIO_INTMASK) | BIT(hwirq);
307	dwapb_write(gpio, GPIO_INTMASK, val);
308	val = dwapb_read(gpio, GPIO_INTEN) & ~BIT(hwirq);
309	dwapb_write(gpio, GPIO_INTEN, val);
310	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
311}
312
313static int dwapb_irq_set_type(struct irq_data *d, u32 type)
314{
315	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
316	struct dwapb_gpio *gpio = to_dwapb_gpio(gc);
317	irq_hw_number_t bit = irqd_to_hwirq(d);
 
318	unsigned long level, polarity, flags;
319
320	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
321	level = dwapb_read(gpio, GPIO_INTTYPE_LEVEL);
322	polarity = dwapb_read(gpio, GPIO_INT_POLARITY);
 
 
 
 
323
324	switch (type) {
325	case IRQ_TYPE_EDGE_BOTH:
326		level |= BIT(bit);
327		dwapb_toggle_trigger(gpio, bit);
328		break;
329	case IRQ_TYPE_EDGE_RISING:
330		level |= BIT(bit);
331		polarity |= BIT(bit);
332		break;
333	case IRQ_TYPE_EDGE_FALLING:
334		level |= BIT(bit);
335		polarity &= ~BIT(bit);
336		break;
337	case IRQ_TYPE_LEVEL_HIGH:
338		level &= ~BIT(bit);
339		polarity |= BIT(bit);
340		break;
341	case IRQ_TYPE_LEVEL_LOW:
342		level &= ~BIT(bit);
343		polarity &= ~BIT(bit);
344		break;
345	}
346
347	if (type & IRQ_TYPE_LEVEL_MASK)
348		irq_set_handler_locked(d, handle_level_irq);
349	else if (type & IRQ_TYPE_EDGE_BOTH)
350		irq_set_handler_locked(d, handle_edge_irq);
351
352	dwapb_write(gpio, GPIO_INTTYPE_LEVEL, level);
353	if (type != IRQ_TYPE_EDGE_BOTH)
354		dwapb_write(gpio, GPIO_INT_POLARITY, polarity);
355	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
356
357	return 0;
358}
359
360#ifdef CONFIG_PM_SLEEP
361static int dwapb_irq_set_wake(struct irq_data *d, unsigned int enable)
362{
363	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
364	struct dwapb_gpio *gpio = to_dwapb_gpio(gc);
365	struct dwapb_context *ctx = gpio->ports[0].ctx;
366	irq_hw_number_t bit = irqd_to_hwirq(d);
367
368	if (enable)
369		ctx->wake_en |= BIT(bit);
370	else
371		ctx->wake_en &= ~BIT(bit);
372
373	return 0;
374}
375#else
376#define dwapb_irq_set_wake	NULL
377#endif
378
379static const struct irq_chip dwapb_irq_chip = {
380	.name		= DWAPB_DRIVER_NAME,
381	.irq_ack	= dwapb_irq_ack,
382	.irq_mask	= dwapb_irq_mask,
383	.irq_unmask	= dwapb_irq_unmask,
384	.irq_set_type	= dwapb_irq_set_type,
385	.irq_enable	= dwapb_irq_enable,
386	.irq_disable	= dwapb_irq_disable,
387	.irq_set_wake	= dwapb_irq_set_wake,
388	.flags		= IRQCHIP_IMMUTABLE,
389	GPIOCHIP_IRQ_RESOURCE_HELPERS,
390};
391
392static int dwapb_gpio_set_debounce(struct gpio_chip *gc,
393				   unsigned offset, unsigned debounce)
394{
395	struct dwapb_gpio_port *port = gpiochip_get_data(gc);
396	struct dwapb_gpio *gpio = port->gpio;
397	unsigned long flags, val_deb;
398	unsigned long mask = BIT(offset);
399
400	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
401
402	val_deb = dwapb_read(gpio, GPIO_PORTA_DEBOUNCE);
403	if (debounce)
404		val_deb |= mask;
405	else
406		val_deb &= ~mask;
407	dwapb_write(gpio, GPIO_PORTA_DEBOUNCE, val_deb);
408
409	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
410
411	return 0;
412}
413
414static int dwapb_gpio_set_config(struct gpio_chip *gc, unsigned offset,
415				 unsigned long config)
416{
417	u32 debounce;
418
419	if (pinconf_to_config_param(config) == PIN_CONFIG_INPUT_DEBOUNCE) {
420		debounce = pinconf_to_config_argument(config);
421		return dwapb_gpio_set_debounce(gc, offset, debounce);
 
 
 
 
 
 
 
422	}
423
424	return gpiochip_generic_config(gc, offset, config);
425}
426
427static int dwapb_convert_irqs(struct dwapb_gpio_port_irqchip *pirq,
428			      struct dwapb_port_property *pp)
429{
430	int i;
431
432	/* Group all available IRQs into an array of parental IRQs. */
433	for (i = 0; i < pp->ngpio; ++i) {
434		if (!pp->irq[i])
435			continue;
436
437		pirq->irq[pirq->nr_irqs++] = pp->irq[i];
 
 
 
 
 
 
 
 
438	}
439
440	return pirq->nr_irqs ? 0 : -ENOENT;
441}
442
443static void dwapb_configure_irqs(struct dwapb_gpio *gpio,
444				 struct dwapb_gpio_port *port,
445				 struct dwapb_port_property *pp)
446{
447	struct dwapb_gpio_port_irqchip *pirq;
448	struct gpio_chip *gc = &port->gc;
449	struct gpio_irq_chip *girq;
450	int err;
451
452	pirq = devm_kzalloc(gpio->dev, sizeof(*pirq), GFP_KERNEL);
453	if (!pirq)
454		return;
455
456	if (dwapb_convert_irqs(pirq, pp)) {
457		dev_warn(gpio->dev, "no IRQ for port%d\n", pp->idx);
458		goto err_kfree_pirq;
459	}
460
461	girq = &gc->irq;
462	girq->handler = handle_bad_irq;
463	girq->default_type = IRQ_TYPE_NONE;
464
465	port->pirq = pirq;
466
467	/*
468	 * Intel ACPI-based platforms mostly have the DesignWare APB GPIO
469	 * IRQ lane shared between several devices. In that case the parental
470	 * IRQ has to be handled in the shared way so to be properly delivered
471	 * to all the connected devices.
472	 */
473	if (has_acpi_companion(gpio->dev)) {
474		girq->num_parents = 0;
475		girq->parents = NULL;
476		girq->parent_handler = NULL;
477
478		err = devm_request_irq(gpio->dev, pp->irq[0],
479				       dwapb_irq_handler_mfd,
480				       IRQF_SHARED, DWAPB_DRIVER_NAME, gpio);
481		if (err) {
482			dev_err(gpio->dev, "error requesting IRQ\n");
483			goto err_kfree_pirq;
484		}
485	} else {
486		girq->num_parents = pirq->nr_irqs;
487		girq->parents = pirq->irq;
488		girq->parent_handler_data = gpio;
489		girq->parent_handler = dwapb_irq_handler;
490	}
 
 
 
 
 
 
491
492	gpio_irq_chip_set_chip(girq, &dwapb_irq_chip);
 
493
494	return;
 
495
496err_kfree_pirq:
497	devm_kfree(gpio->dev, pirq);
498}
499
500static int dwapb_gpio_add_port(struct dwapb_gpio *gpio,
501			       struct dwapb_port_property *pp,
502			       unsigned int offs)
503{
504	struct dwapb_gpio_port *port;
 
505	void __iomem *dat, *set, *dirout;
506	int err;
507
 
 
 
 
 
 
 
508	port = &gpio->ports[offs];
509	port->gpio = gpio;
510	port->idx = pp->idx;
511
512#ifdef CONFIG_PM_SLEEP
513	port->ctx = devm_kzalloc(gpio->dev, sizeof(*port->ctx), GFP_KERNEL);
514	if (!port->ctx)
515		return -ENOMEM;
516#endif
517
518	dat = gpio->regs + GPIO_EXT_PORTA + pp->idx * GPIO_EXT_PORT_STRIDE;
519	set = gpio->regs + GPIO_SWPORTA_DR + pp->idx * GPIO_SWPORT_DR_STRIDE;
520	dirout = gpio->regs + GPIO_SWPORTA_DDR + pp->idx * GPIO_SWPORT_DDR_STRIDE;
521
522	/* This registers 32 GPIO lines per port */
523	err = bgpio_init(&port->gc, gpio->dev, 4, dat, set, NULL, dirout,
524			 NULL, 0);
525	if (err) {
526		dev_err(gpio->dev, "failed to init gpio chip for port%d\n",
527			port->idx);
528		return err;
529	}
530
531	port->gc.fwnode = pp->fwnode;
532	port->gc.ngpio = pp->ngpio;
533	port->gc.base = pp->gpio_base;
534	port->gc.request = gpiochip_generic_request;
535	port->gc.free = gpiochip_generic_free;
536
537	/* Only port A support debounce */
538	if (pp->idx == 0)
539		port->gc.set_config = dwapb_gpio_set_config;
540	else
541		port->gc.set_config = gpiochip_generic_config;
542
543	/* Only port A can provide interrupts in all configurations of the IP */
544	if (pp->idx == 0)
545		dwapb_configure_irqs(gpio, port, pp);
546
547	err = devm_gpiochip_add_data(gpio->dev, &port->gc, port);
 
548	if (err) {
549		dev_err(gpio->dev, "failed to register gpiochip for port%d\n",
550			port->idx);
551		return err;
552	}
553
554	return 0;
555}
556
557static void dwapb_get_irq(struct device *dev, struct fwnode_handle *fwnode,
558			  struct dwapb_port_property *pp)
559{
560	int irq, j;
561
562	for (j = 0; j < pp->ngpio; j++) {
563		if (has_acpi_companion(dev))
564			irq = platform_get_irq_optional(to_platform_device(dev), j);
565		else
566			irq = fwnode_irq_get(fwnode, j);
567		if (irq > 0)
568			pp->irq[j] = irq;
569	}
570}
571
572static struct dwapb_platform_data *dwapb_gpio_get_pdata(struct device *dev)
573{
574	struct dwapb_platform_data *pdata;
575	struct dwapb_port_property *pp;
576	int nports;
577	int i;
578
579	nports = device_get_child_node_count(dev);
580	if (nports == 0)
581		return ERR_PTR(-ENODEV);
582
583	pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
584	if (!pdata)
585		return ERR_PTR(-ENOMEM);
586
587	pdata->properties = devm_kcalloc(dev, nports, sizeof(*pp), GFP_KERNEL);
588	if (!pdata->properties)
589		return ERR_PTR(-ENOMEM);
590
591	pdata->nports = nports;
592
593	i = 0;
594	device_for_each_child_node_scoped(dev, fwnode)  {
595		pp = &pdata->properties[i++];
596		pp->fwnode = fwnode;
597
598		if (fwnode_property_read_u32(fwnode, "reg", &pp->idx) ||
599		    pp->idx >= DWAPB_MAX_PORTS) {
600			dev_err(dev,
601				"missing/invalid port index for port%d\n", i);
602			return ERR_PTR(-EINVAL);
603		}
604
605		if (fwnode_property_read_u32(fwnode, "ngpios", &pp->ngpio) &&
606		    fwnode_property_read_u32(fwnode, "snps,nr-gpios", &pp->ngpio)) {
607			dev_info(dev,
608				 "failed to get number of gpios for port%d\n",
609				 i);
610			pp->ngpio = DWAPB_MAX_GPIOS;
611		}
612
613		pp->gpio_base	= -1;
614
615		/* For internal use only, new platforms mustn't exercise this */
616		if (is_software_node(fwnode))
617			fwnode_property_read_u32(fwnode, "gpio-base", &pp->gpio_base);
618
619		/*
620		 * Only port A can provide interrupts in all configurations of
621		 * the IP.
622		 */
623		if (pp->idx == 0)
624			dwapb_get_irq(dev, fwnode, pp);
625	}
626
627	return pdata;
628}
629
630static void dwapb_assert_reset(void *data)
631{
632	struct dwapb_gpio *gpio = data;
633
634	reset_control_assert(gpio->rst);
635}
636
637static int dwapb_get_reset(struct dwapb_gpio *gpio)
638{
639	int err;
640
641	gpio->rst = devm_reset_control_get_optional_shared(gpio->dev, NULL);
642	if (IS_ERR(gpio->rst))
643		return dev_err_probe(gpio->dev, PTR_ERR(gpio->rst),
644				     "Cannot get reset descriptor\n");
645
646	err = reset_control_deassert(gpio->rst);
647	if (err) {
648		dev_err(gpio->dev, "Cannot deassert reset lane\n");
649		return err;
650	}
651
652	return devm_add_action_or_reset(gpio->dev, dwapb_assert_reset, gpio);
653}
654
655static void dwapb_disable_clks(void *data)
656{
657	struct dwapb_gpio *gpio = data;
 
 
 
658
659	clk_bulk_disable_unprepare(DWAPB_NR_CLOCKS, gpio->clks);
660}
661
662static int dwapb_get_clks(struct dwapb_gpio *gpio)
663{
664	int err;
665
666	/* Optional bus and debounce clocks */
667	gpio->clks[0].id = "bus";
668	gpio->clks[1].id = "db";
669	err = devm_clk_bulk_get_optional(gpio->dev, DWAPB_NR_CLOCKS,
670					 gpio->clks);
671	if (err)
672		return dev_err_probe(gpio->dev, err,
673				     "Cannot get APB/Debounce clocks\n");
674
675	err = clk_bulk_prepare_enable(DWAPB_NR_CLOCKS, gpio->clks);
676	if (err) {
677		dev_err(gpio->dev, "Cannot enable APB/Debounce clocks\n");
678		return err;
679	}
680
681	return devm_add_action_or_reset(gpio->dev, dwapb_disable_clks, gpio);
682}
683
684static const struct of_device_id dwapb_of_match[] = {
685	{ .compatible = "snps,dw-apb-gpio", .data = (void *)GPIO_REG_OFFSET_V1},
686	{ .compatible = "apm,xgene-gpio-v2", .data = (void *)GPIO_REG_OFFSET_V2},
687	{ /* Sentinel */ }
688};
689MODULE_DEVICE_TABLE(of, dwapb_of_match);
690
691static const struct acpi_device_id dwapb_acpi_match[] = {
692	{"HISI0181", GPIO_REG_OFFSET_V1},
693	{"APMC0D07", GPIO_REG_OFFSET_V1},
694	{"APMC0D81", GPIO_REG_OFFSET_V2},
695	{"FUJI200A", GPIO_REG_OFFSET_V1},
696	{ }
697};
698MODULE_DEVICE_TABLE(acpi, dwapb_acpi_match);
699
700static int dwapb_gpio_probe(struct platform_device *pdev)
701{
702	unsigned int i;
703	struct dwapb_gpio *gpio;
 
704	int err;
705	struct dwapb_platform_data *pdata;
706	struct device *dev = &pdev->dev;
707
708	pdata = dwapb_gpio_get_pdata(dev);
709	if (IS_ERR(pdata))
710		return PTR_ERR(pdata);
711
712	gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
713	if (!gpio)
714		return -ENOMEM;
715
716	gpio->dev = &pdev->dev;
717	gpio->nr_ports = pdata->nports;
718
719	err = dwapb_get_reset(gpio);
720	if (err)
721		return err;
722
723	gpio->ports = devm_kcalloc(&pdev->dev, gpio->nr_ports,
 
 
 
 
 
724				   sizeof(*gpio->ports), GFP_KERNEL);
725	if (!gpio->ports)
726		return -ENOMEM;
727
728	gpio->regs = devm_platform_ioremap_resource(pdev, 0);
729	if (IS_ERR(gpio->regs))
730		return PTR_ERR(gpio->regs);
731
732	err = dwapb_get_clks(gpio);
733	if (err)
734		return err;
735
736	gpio->flags = (uintptr_t)device_get_match_data(dev);
 
 
 
 
 
737
738	for (i = 0; i < gpio->nr_ports; i++) {
739		err = dwapb_gpio_add_port(gpio, &pdata->properties[i], i);
740		if (err)
741			return err;
742	}
743
744	platform_set_drvdata(pdev, gpio);
745
746	return 0;
747}
748
749#ifdef CONFIG_PM_SLEEP
750static int dwapb_gpio_suspend(struct device *dev)
751{
752	struct dwapb_gpio *gpio = dev_get_drvdata(dev);
753	struct gpio_chip *gc	= &gpio->ports[0].gc;
754	unsigned long flags;
755	int i;
756
757	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
758	for (i = 0; i < gpio->nr_ports; i++) {
759		unsigned int offset;
760		unsigned int idx = gpio->ports[i].idx;
761		struct dwapb_context *ctx = gpio->ports[i].ctx;
762
763		offset = GPIO_SWPORTA_DDR + idx * GPIO_SWPORT_DDR_STRIDE;
764		ctx->dir = dwapb_read(gpio, offset);
765
766		offset = GPIO_SWPORTA_DR + idx * GPIO_SWPORT_DR_STRIDE;
767		ctx->data = dwapb_read(gpio, offset);
768
769		offset = GPIO_EXT_PORTA + idx * GPIO_EXT_PORT_STRIDE;
770		ctx->ext = dwapb_read(gpio, offset);
771
772		/* Only port A can provide interrupts */
773		if (idx == 0) {
774			ctx->int_mask	= dwapb_read(gpio, GPIO_INTMASK);
775			ctx->int_en	= dwapb_read(gpio, GPIO_INTEN);
776			ctx->int_pol	= dwapb_read(gpio, GPIO_INT_POLARITY);
777			ctx->int_type	= dwapb_read(gpio, GPIO_INTTYPE_LEVEL);
778			ctx->int_deb	= dwapb_read(gpio, GPIO_PORTA_DEBOUNCE);
779
780			/* Mask out interrupts */
781			dwapb_write(gpio, GPIO_INTMASK, ~ctx->wake_en);
782		}
783	}
784	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
785
786	clk_bulk_disable_unprepare(DWAPB_NR_CLOCKS, gpio->clks);
787
788	return 0;
789}
790
791static int dwapb_gpio_resume(struct device *dev)
792{
793	struct dwapb_gpio *gpio = dev_get_drvdata(dev);
794	struct gpio_chip *gc	= &gpio->ports[0].gc;
795	unsigned long flags;
796	int i, err;
797
798	err = clk_bulk_prepare_enable(DWAPB_NR_CLOCKS, gpio->clks);
799	if (err) {
800		dev_err(gpio->dev, "Cannot reenable APB/Debounce clocks\n");
801		return err;
802	}
803
804	raw_spin_lock_irqsave(&gc->bgpio_lock, flags);
805	for (i = 0; i < gpio->nr_ports; i++) {
806		unsigned int offset;
807		unsigned int idx = gpio->ports[i].idx;
808		struct dwapb_context *ctx = gpio->ports[i].ctx;
809
810		offset = GPIO_SWPORTA_DR + idx * GPIO_SWPORT_DR_STRIDE;
811		dwapb_write(gpio, offset, ctx->data);
812
813		offset = GPIO_SWPORTA_DDR + idx * GPIO_SWPORT_DDR_STRIDE;
814		dwapb_write(gpio, offset, ctx->dir);
815
816		offset = GPIO_EXT_PORTA + idx * GPIO_EXT_PORT_STRIDE;
817		dwapb_write(gpio, offset, ctx->ext);
818
819		/* Only port A can provide interrupts */
820		if (idx == 0) {
821			dwapb_write(gpio, GPIO_INTTYPE_LEVEL, ctx->int_type);
822			dwapb_write(gpio, GPIO_INT_POLARITY, ctx->int_pol);
823			dwapb_write(gpio, GPIO_PORTA_DEBOUNCE, ctx->int_deb);
824			dwapb_write(gpio, GPIO_INTEN, ctx->int_en);
825			dwapb_write(gpio, GPIO_INTMASK, ctx->int_mask);
826
827			/* Clear out spurious interrupts */
828			dwapb_write(gpio, GPIO_PORTA_EOI, 0xffffffff);
829		}
830	}
831	raw_spin_unlock_irqrestore(&gc->bgpio_lock, flags);
832
833	return 0;
834}
835#endif
836
837static SIMPLE_DEV_PM_OPS(dwapb_gpio_pm_ops, dwapb_gpio_suspend,
838			 dwapb_gpio_resume);
 
 
 
839
840static struct platform_driver dwapb_gpio_driver = {
841	.driver		= {
842		.name	= DWAPB_DRIVER_NAME,
843		.pm	= &dwapb_gpio_pm_ops,
844		.of_match_table = dwapb_of_match,
845		.acpi_match_table = dwapb_acpi_match,
846	},
847	.probe		= dwapb_gpio_probe,
 
848};
849
850module_platform_driver(dwapb_gpio_driver);
851
852MODULE_LICENSE("GPL");
853MODULE_AUTHOR("Jamie Iles");
854MODULE_DESCRIPTION("Synopsys DesignWare APB GPIO driver");
855MODULE_ALIAS("platform:" DWAPB_DRIVER_NAME);
v3.15
 
  1/*
  2 * Copyright (c) 2011 Jamie Iles
  3 *
  4 * This program is free software; you can redistribute it and/or modify
  5 * it under the terms of the GNU General Public License version 2 as
  6 * published by the Free Software Foundation.
  7 *
  8 * All enquiries to support@picochip.com
  9 */
 10#include <linux/basic_mmio_gpio.h>
 
 11#include <linux/err.h>
 
 12#include <linux/init.h>
 13#include <linux/interrupt.h>
 14#include <linux/io.h>
 15#include <linux/ioport.h>
 16#include <linux/irq.h>
 17#include <linux/irqdomain.h>
 18#include <linux/module.h>
 19#include <linux/of.h>
 20#include <linux/of_address.h>
 21#include <linux/of_irq.h>
 22#include <linux/platform_device.h>
 
 
 
 23#include <linux/spinlock.h>
 24
 
 
 25#define GPIO_SWPORTA_DR		0x00
 26#define GPIO_SWPORTA_DDR	0x04
 27#define GPIO_SWPORTB_DR		0x0c
 28#define GPIO_SWPORTB_DDR	0x10
 29#define GPIO_SWPORTC_DR		0x18
 30#define GPIO_SWPORTC_DDR	0x1c
 31#define GPIO_SWPORTD_DR		0x24
 32#define GPIO_SWPORTD_DDR	0x28
 33#define GPIO_INTEN		0x30
 34#define GPIO_INTMASK		0x34
 35#define GPIO_INTTYPE_LEVEL	0x38
 36#define GPIO_INT_POLARITY	0x3c
 37#define GPIO_INTSTATUS		0x40
 
 38#define GPIO_PORTA_EOI		0x4c
 39#define GPIO_EXT_PORTA		0x50
 40#define GPIO_EXT_PORTB		0x54
 41#define GPIO_EXT_PORTC		0x58
 42#define GPIO_EXT_PORTD		0x5c
 43
 
 44#define DWAPB_MAX_PORTS		4
 45#define GPIO_EXT_PORT_SIZE	(GPIO_EXT_PORTB - GPIO_EXT_PORTA)
 46#define GPIO_SWPORT_DR_SIZE	(GPIO_SWPORTB_DR - GPIO_SWPORTA_DR)
 47#define GPIO_SWPORT_DDR_SIZE	(GPIO_SWPORTB_DDR - GPIO_SWPORTA_DDR)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 48
 49struct dwapb_gpio;
 50
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 51struct dwapb_gpio_port {
 52	struct bgpio_chip	bgc;
 53	bool			is_registered;
 54	struct dwapb_gpio	*gpio;
 
 
 
 
 55};
 
 
 56
 57struct dwapb_gpio {
 58	struct	device		*dev;
 59	void __iomem		*regs;
 60	struct dwapb_gpio_port	*ports;
 61	unsigned int		nr_ports;
 62	struct irq_domain	*domain;
 
 
 63};
 64
 65static int dwapb_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 66{
 67	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 68	struct dwapb_gpio_port *port = container_of(bgc, struct
 69						    dwapb_gpio_port, bgc);
 70	struct dwapb_gpio *gpio = port->gpio;
 
 
 
 
 
 
 
 
 
 
 
 
 71
 72	return irq_find_mapping(gpio->domain, offset);
 73}
 74
 75static void dwapb_toggle_trigger(struct dwapb_gpio *gpio, unsigned int offs)
 76{
 77	u32 v = readl(gpio->regs + GPIO_INT_POLARITY);
 
 
 
 
 
 
 
 78
 79	if (gpio_get_value(gpio->ports[0].bgc.gc.base + offs))
 80		v &= ~BIT(offs);
 
 
 
 81	else
 82		v |= BIT(offs);
 83
 84	writel(v, gpio->regs + GPIO_INT_POLARITY);
 85}
 86
 87static void dwapb_irq_handler(u32 irq, struct irq_desc *desc)
 88{
 89	struct dwapb_gpio *gpio = irq_get_handler_data(irq);
 90	struct irq_chip *chip = irq_desc_get_chip(desc);
 91	u32 irq_status = readl_relaxed(gpio->regs + GPIO_INTSTATUS);
 92
 93	while (irq_status) {
 94		int hwirq = fls(irq_status) - 1;
 95		int gpio_irq = irq_find_mapping(gpio->domain, hwirq);
 
 96
 97		generic_handle_irq(gpio_irq);
 98		irq_status &= ~BIT(hwirq);
 99
100		if ((irq_get_trigger_type(gpio_irq) & IRQ_TYPE_SENSE_MASK)
101			== IRQ_TYPE_EDGE_BOTH)
102			dwapb_toggle_trigger(gpio, hwirq);
103	}
104
105	if (chip->irq_eoi)
106		chip->irq_eoi(irq_desc_get_irq_data(desc));
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
107}
108
109static void dwapb_irq_enable(struct irq_data *d)
110{
111	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
112	struct dwapb_gpio *gpio = igc->private;
113	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
114	unsigned long flags;
115	u32 val;
116
117	spin_lock_irqsave(&bgc->lock, flags);
118	val = readl(gpio->regs + GPIO_INTEN);
119	val |= BIT(d->hwirq);
120	writel(val, gpio->regs + GPIO_INTEN);
121	spin_unlock_irqrestore(&bgc->lock, flags);
 
122}
123
124static void dwapb_irq_disable(struct irq_data *d)
125{
126	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
127	struct dwapb_gpio *gpio = igc->private;
128	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
129	unsigned long flags;
130	u32 val;
131
132	spin_lock_irqsave(&bgc->lock, flags);
133	val = readl(gpio->regs + GPIO_INTEN);
134	val &= ~BIT(d->hwirq);
135	writel(val, gpio->regs + GPIO_INTEN);
136	spin_unlock_irqrestore(&bgc->lock, flags);
137}
138
139static int dwapb_irq_reqres(struct irq_data *d)
140{
141	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
142	struct dwapb_gpio *gpio = igc->private;
143	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
144
145	if (gpio_lock_as_irq(&bgc->gc, irqd_to_hwirq(d))) {
146		dev_err(gpio->dev, "unable to lock HW IRQ %lu for IRQ\n",
147			irqd_to_hwirq(d));
148		return -EINVAL;
149	}
150	return 0;
151}
152
153static void dwapb_irq_relres(struct irq_data *d)
154{
155	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
156	struct dwapb_gpio *gpio = igc->private;
157	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
 
 
158
159	gpio_unlock_as_irq(&bgc->gc, irqd_to_hwirq(d));
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
160}
161
162static int dwapb_irq_set_type(struct irq_data *d, u32 type)
163{
164	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
165	struct dwapb_gpio *gpio = igc->private;
166	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
167	int bit = d->hwirq;
168	unsigned long level, polarity, flags;
169
170	if (type & ~(IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING |
171		     IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW))
172		return -EINVAL;
173
174	spin_lock_irqsave(&bgc->lock, flags);
175	level = readl(gpio->regs + GPIO_INTTYPE_LEVEL);
176	polarity = readl(gpio->regs + GPIO_INT_POLARITY);
177
178	switch (type) {
179	case IRQ_TYPE_EDGE_BOTH:
180		level |= BIT(bit);
181		dwapb_toggle_trigger(gpio, bit);
182		break;
183	case IRQ_TYPE_EDGE_RISING:
184		level |= BIT(bit);
185		polarity |= BIT(bit);
186		break;
187	case IRQ_TYPE_EDGE_FALLING:
188		level |= BIT(bit);
189		polarity &= ~BIT(bit);
190		break;
191	case IRQ_TYPE_LEVEL_HIGH:
192		level &= ~BIT(bit);
193		polarity |= BIT(bit);
194		break;
195	case IRQ_TYPE_LEVEL_LOW:
196		level &= ~BIT(bit);
197		polarity &= ~BIT(bit);
198		break;
199	}
200
201	writel(level, gpio->regs + GPIO_INTTYPE_LEVEL);
202	writel(polarity, gpio->regs + GPIO_INT_POLARITY);
203	spin_unlock_irqrestore(&bgc->lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
204
205	return 0;
206}
207
208static void dwapb_configure_irqs(struct dwapb_gpio *gpio,
209				 struct dwapb_gpio_port *port)
210{
211	struct gpio_chip *gc = &port->bgc.gc;
212	struct device_node *node =  gc->of_node;
213	struct irq_chip_generic	*irq_gc;
214	unsigned int hwirq, ngpio = gc->ngpio;
215	struct irq_chip_type *ct;
216	int err, irq;
217
218	irq = irq_of_parse_and_map(node, 0);
219	if (!irq) {
220		dev_warn(gpio->dev, "no irq for bank %s\n",
221			port->bgc.gc.of_node->full_name);
222		return;
223	}
224
225	gpio->domain = irq_domain_add_linear(node, ngpio,
226					     &irq_generic_chip_ops, gpio);
227	if (!gpio->domain)
228		return;
 
 
 
 
 
 
 
 
229
230	err = irq_alloc_domain_generic_chips(gpio->domain, ngpio, 1,
231					     "gpio-dwapb", handle_level_irq,
232					     IRQ_NOREQUEST, 0,
233					     IRQ_GC_INIT_NESTED_LOCK);
234	if (err) {
235		dev_info(gpio->dev, "irq_alloc_domain_generic_chips failed\n");
236		irq_domain_remove(gpio->domain);
237		gpio->domain = NULL;
238		return;
239	}
240
241	irq_gc = irq_get_domain_generic_chip(gpio->domain, 0);
242	if (!irq_gc) {
243		irq_domain_remove(gpio->domain);
244		gpio->domain = NULL;
 
 
 
 
 
 
 
 
 
 
245		return;
 
 
 
 
246	}
247
248	irq_gc->reg_base = gpio->regs;
249	irq_gc->private = gpio;
 
 
 
250
251	ct = irq_gc->chip_types;
252	ct->chip.irq_ack = irq_gc_ack_set_bit;
253	ct->chip.irq_mask = irq_gc_mask_set_bit;
254	ct->chip.irq_unmask = irq_gc_mask_clr_bit;
255	ct->chip.irq_set_type = dwapb_irq_set_type;
256	ct->chip.irq_enable = dwapb_irq_enable;
257	ct->chip.irq_disable = dwapb_irq_disable;
258	ct->chip.irq_request_resources = dwapb_irq_reqres;
259	ct->chip.irq_release_resources = dwapb_irq_relres;
260	ct->regs.ack = GPIO_PORTA_EOI;
261	ct->regs.mask = GPIO_INTMASK;
262
263	irq_setup_generic_chip(irq_gc, IRQ_MSK(port->bgc.gc.ngpio),
264			IRQ_GC_INIT_NESTED_LOCK, IRQ_NOREQUEST, 0);
265
266	irq_set_chained_handler(irq, dwapb_irq_handler);
267	irq_set_handler_data(irq, gpio);
268
269	for (hwirq = 0 ; hwirq < ngpio ; hwirq++)
270		irq_create_mapping(gpio->domain, hwirq);
271
272	port->bgc.gc.to_irq = dwapb_gpio_to_irq;
273}
274
275static void dwapb_irq_teardown(struct dwapb_gpio *gpio)
276{
277	struct dwapb_gpio_port *port = &gpio->ports[0];
278	struct gpio_chip *gc = &port->bgc.gc;
279	unsigned int ngpio = gc->ngpio;
280	irq_hw_number_t hwirq;
281
282	if (!gpio->domain)
283		return;
284
285	for (hwirq = 0 ; hwirq < ngpio ; hwirq++)
286		irq_dispose_mapping(irq_find_mapping(gpio->domain, hwirq));
287
288	irq_domain_remove(gpio->domain);
289	gpio->domain = NULL;
290}
291
292static int dwapb_gpio_add_port(struct dwapb_gpio *gpio,
293			       struct device_node *port_np,
294			       unsigned int offs)
295{
296	struct dwapb_gpio_port *port;
297	u32 port_idx, ngpio;
298	void __iomem *dat, *set, *dirout;
299	int err;
300
301	if (of_property_read_u32(port_np, "reg", &port_idx) ||
302		port_idx >= DWAPB_MAX_PORTS) {
303		dev_err(gpio->dev, "missing/invalid port index for %s\n",
304			port_np->full_name);
305		return -EINVAL;
306	}
307
308	port = &gpio->ports[offs];
309	port->gpio = gpio;
 
 
 
 
 
 
 
310
311	if (of_property_read_u32(port_np, "snps,nr-gpios", &ngpio)) {
312		dev_info(gpio->dev, "failed to get number of gpios for %s\n",
313			 port_np->full_name);
314		ngpio = 32;
 
 
 
 
 
 
 
315	}
316
317	dat = gpio->regs + GPIO_EXT_PORTA + (port_idx * GPIO_EXT_PORT_SIZE);
318	set = gpio->regs + GPIO_SWPORTA_DR + (port_idx * GPIO_SWPORT_DR_SIZE);
319	dirout = gpio->regs + GPIO_SWPORTA_DDR +
320		(port_idx * GPIO_SWPORT_DDR_SIZE);
 
 
 
 
 
 
 
 
 
 
 
321
322	err = bgpio_init(&port->bgc, gpio->dev, 4, dat, set, NULL, dirout,
323			 NULL, false);
324	if (err) {
325		dev_err(gpio->dev, "failed to init gpio chip for %s\n",
326			port_np->full_name);
327		return err;
328	}
329
330	port->bgc.gc.ngpio = ngpio;
331	port->bgc.gc.of_node = port_np;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
332
333	/*
334	 * Only port A can provide interrupts in all configurations of the IP.
335	 */
336	if (port_idx == 0 &&
337	    of_property_read_bool(port_np, "interrupt-controller"))
338		dwapb_configure_irqs(gpio, port);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
339
340	err = gpiochip_add(&port->bgc.gc);
341	if (err)
342		dev_err(gpio->dev, "failed to register gpiochip for %s\n",
343			port_np->full_name);
344	else
345		port->is_registered = true;
346
347	return err;
348}
349
350static void dwapb_gpio_unregister(struct dwapb_gpio *gpio)
351{
352	unsigned int m;
353
354	for (m = 0; m < gpio->nr_ports; ++m)
355		if (gpio->ports[m].is_registered)
356			WARN_ON(gpiochip_remove(&gpio->ports[m].bgc.gc));
 
 
 
 
 
 
 
 
 
 
 
 
 
357}
358
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
359static int dwapb_gpio_probe(struct platform_device *pdev)
360{
361	struct resource *res;
362	struct dwapb_gpio *gpio;
363	struct device_node *np;
364	int err;
365	unsigned int offs = 0;
 
 
 
 
 
366
367	gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
368	if (!gpio)
369		return -ENOMEM;
 
370	gpio->dev = &pdev->dev;
 
 
 
 
 
371
372	gpio->nr_ports = of_get_child_count(pdev->dev.of_node);
373	if (!gpio->nr_ports) {
374		err = -EINVAL;
375		goto out_err;
376	}
377	gpio->ports = devm_kzalloc(&pdev->dev, gpio->nr_ports *
378				   sizeof(*gpio->ports), GFP_KERNEL);
379	if (!gpio->ports) {
380		err = -ENOMEM;
381		goto out_err;
382	}
 
 
 
 
 
 
383
384	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
385	gpio->regs = devm_ioremap_resource(&pdev->dev, res);
386	if (IS_ERR(gpio->regs)) {
387		err = PTR_ERR(gpio->regs);
388		goto out_err;
389	}
390
391	for_each_child_of_node(pdev->dev.of_node, np) {
392		err = dwapb_gpio_add_port(gpio, np, offs++);
393		if (err)
394			goto out_unregister;
395	}
 
396	platform_set_drvdata(pdev, gpio);
397
398	return 0;
 
 
 
 
 
 
 
 
 
399
400out_unregister:
401	dwapb_gpio_unregister(gpio);
402	dwapb_irq_teardown(gpio);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
403
404out_err:
405	return err;
 
406}
407
408static int dwapb_gpio_remove(struct platform_device *pdev)
409{
410	struct dwapb_gpio *gpio = platform_get_drvdata(pdev);
 
 
 
 
 
 
 
 
 
411
412	dwapb_gpio_unregister(gpio);
413	dwapb_irq_teardown(gpio);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
414
415	return 0;
416}
 
417
418static const struct of_device_id dwapb_of_match[] = {
419	{ .compatible = "snps,dw-apb-gpio" },
420	{ /* Sentinel */ }
421};
422MODULE_DEVICE_TABLE(of, dwapb_of_match);
423
424static struct platform_driver dwapb_gpio_driver = {
425	.driver		= {
426		.name	= "gpio-dwapb",
427		.owner	= THIS_MODULE,
428		.of_match_table = of_match_ptr(dwapb_of_match),
 
429	},
430	.probe		= dwapb_gpio_probe,
431	.remove		= dwapb_gpio_remove,
432};
433
434module_platform_driver(dwapb_gpio_driver);
435
436MODULE_LICENSE("GPL");
437MODULE_AUTHOR("Jamie Iles");
438MODULE_DESCRIPTION("Synopsys DesignWare APB GPIO driver");