Linux Audio

Check our new training course

Loading...
v6.9.4
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Library implementing the most common irq chip callback functions
  4 *
  5 * Copyright (C) 2011, Thomas Gleixner
  6 */
  7#include <linux/io.h>
  8#include <linux/irq.h>
  9#include <linux/slab.h>
 10#include <linux/export.h>
 11#include <linux/irqdomain.h>
 12#include <linux/interrupt.h>
 13#include <linux/kernel_stat.h>
 14#include <linux/syscore_ops.h>
 15
 16#include "internals.h"
 17
 18static LIST_HEAD(gc_list);
 19static DEFINE_RAW_SPINLOCK(gc_lock);
 20
 21/**
 22 * irq_gc_noop - NOOP function
 23 * @d: irq_data
 24 */
 25void irq_gc_noop(struct irq_data *d)
 26{
 27}
 28EXPORT_SYMBOL_GPL(irq_gc_noop);
 29
 30/**
 31 * irq_gc_mask_disable_reg - Mask chip via disable register
 32 * @d: irq_data
 33 *
 34 * Chip has separate enable/disable registers instead of a single mask
 35 * register.
 36 */
 37void irq_gc_mask_disable_reg(struct irq_data *d)
 38{
 39	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
 40	struct irq_chip_type *ct = irq_data_get_chip_type(d);
 41	u32 mask = d->mask;
 42
 43	irq_gc_lock(gc);
 44	irq_reg_writel(gc, mask, ct->regs.disable);
 45	*ct->mask_cache &= ~mask;
 46	irq_gc_unlock(gc);
 47}
 48EXPORT_SYMBOL_GPL(irq_gc_mask_disable_reg);
 49
 50/**
 51 * irq_gc_mask_set_bit - Mask chip via setting bit in mask register
 52 * @d: irq_data
 53 *
 54 * Chip has a single mask register. Values of this register are cached
 55 * and protected by gc->lock
 56 */
 57void irq_gc_mask_set_bit(struct irq_data *d)
 58{
 59	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
 60	struct irq_chip_type *ct = irq_data_get_chip_type(d);
 61	u32 mask = d->mask;
 62
 63	irq_gc_lock(gc);
 64	*ct->mask_cache |= mask;
 65	irq_reg_writel(gc, *ct->mask_cache, ct->regs.mask);
 66	irq_gc_unlock(gc);
 67}
 68EXPORT_SYMBOL_GPL(irq_gc_mask_set_bit);
 69
 70/**
 71 * irq_gc_mask_clr_bit - Mask chip via clearing bit in mask register
 72 * @d: irq_data
 73 *
 74 * Chip has a single mask register. Values of this register are cached
 75 * and protected by gc->lock
 76 */
 77void irq_gc_mask_clr_bit(struct irq_data *d)
 78{
 79	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
 80	struct irq_chip_type *ct = irq_data_get_chip_type(d);
 81	u32 mask = d->mask;
 82
 83	irq_gc_lock(gc);
 84	*ct->mask_cache &= ~mask;
 85	irq_reg_writel(gc, *ct->mask_cache, ct->regs.mask);
 86	irq_gc_unlock(gc);
 87}
 88EXPORT_SYMBOL_GPL(irq_gc_mask_clr_bit);
 89
 90/**
 91 * irq_gc_unmask_enable_reg - Unmask chip via enable register
 92 * @d: irq_data
 93 *
 94 * Chip has separate enable/disable registers instead of a single mask
 95 * register.
 96 */
 97void irq_gc_unmask_enable_reg(struct irq_data *d)
 98{
 99	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
100	struct irq_chip_type *ct = irq_data_get_chip_type(d);
101	u32 mask = d->mask;
102
103	irq_gc_lock(gc);
104	irq_reg_writel(gc, mask, ct->regs.enable);
105	*ct->mask_cache |= mask;
106	irq_gc_unlock(gc);
107}
108EXPORT_SYMBOL_GPL(irq_gc_unmask_enable_reg);
109
110/**
111 * irq_gc_ack_set_bit - Ack pending interrupt via setting bit
112 * @d: irq_data
113 */
114void irq_gc_ack_set_bit(struct irq_data *d)
115{
116	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
117	struct irq_chip_type *ct = irq_data_get_chip_type(d);
118	u32 mask = d->mask;
119
120	irq_gc_lock(gc);
121	irq_reg_writel(gc, mask, ct->regs.ack);
122	irq_gc_unlock(gc);
123}
124EXPORT_SYMBOL_GPL(irq_gc_ack_set_bit);
125
126/**
127 * irq_gc_ack_clr_bit - Ack pending interrupt via clearing bit
128 * @d: irq_data
129 */
130void irq_gc_ack_clr_bit(struct irq_data *d)
131{
132	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
133	struct irq_chip_type *ct = irq_data_get_chip_type(d);
134	u32 mask = ~d->mask;
135
136	irq_gc_lock(gc);
137	irq_reg_writel(gc, mask, ct->regs.ack);
138	irq_gc_unlock(gc);
139}
140
141/**
142 * irq_gc_mask_disable_and_ack_set - Mask and ack pending interrupt
143 * @d: irq_data
144 *
145 * This generic implementation of the irq_mask_ack method is for chips
146 * with separate enable/disable registers instead of a single mask
147 * register and where a pending interrupt is acknowledged by setting a
148 * bit.
149 *
150 * Note: This is the only permutation currently used.  Similar generic
151 * functions should be added here if other permutations are required.
152 */
153void irq_gc_mask_disable_and_ack_set(struct irq_data *d)
154{
155	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
156	struct irq_chip_type *ct = irq_data_get_chip_type(d);
157	u32 mask = d->mask;
158
159	irq_gc_lock(gc);
160	irq_reg_writel(gc, mask, ct->regs.disable);
161	*ct->mask_cache &= ~mask;
162	irq_reg_writel(gc, mask, ct->regs.ack);
163	irq_gc_unlock(gc);
164}
165
166/**
167 * irq_gc_eoi - EOI interrupt
168 * @d: irq_data
169 */
170void irq_gc_eoi(struct irq_data *d)
171{
172	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
173	struct irq_chip_type *ct = irq_data_get_chip_type(d);
174	u32 mask = d->mask;
175
176	irq_gc_lock(gc);
177	irq_reg_writel(gc, mask, ct->regs.eoi);
178	irq_gc_unlock(gc);
179}
180
181/**
182 * irq_gc_set_wake - Set/clr wake bit for an interrupt
183 * @d:  irq_data
184 * @on: Indicates whether the wake bit should be set or cleared
185 *
186 * For chips where the wake from suspend functionality is not
187 * configured in a separate register and the wakeup active state is
188 * just stored in a bitmask.
189 */
190int irq_gc_set_wake(struct irq_data *d, unsigned int on)
191{
192	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
193	u32 mask = d->mask;
194
195	if (!(mask & gc->wake_enabled))
196		return -EINVAL;
197
198	irq_gc_lock(gc);
199	if (on)
200		gc->wake_active |= mask;
201	else
202		gc->wake_active &= ~mask;
203	irq_gc_unlock(gc);
204	return 0;
205}
206EXPORT_SYMBOL_GPL(irq_gc_set_wake);
207
208static u32 irq_readl_be(void __iomem *addr)
209{
210	return ioread32be(addr);
211}
212
213static void irq_writel_be(u32 val, void __iomem *addr)
214{
215	iowrite32be(val, addr);
216}
217
218void irq_init_generic_chip(struct irq_chip_generic *gc, const char *name,
219			   int num_ct, unsigned int irq_base,
220			   void __iomem *reg_base, irq_flow_handler_t handler)
221{
222	struct irq_chip_type *ct = gc->chip_types;
223	int i;
224
225	raw_spin_lock_init(&gc->lock);
226	gc->num_ct = num_ct;
227	gc->irq_base = irq_base;
228	gc->reg_base = reg_base;
229	for (i = 0; i < num_ct; i++)
230		ct[i].chip.name = name;
231	gc->chip_types->handler = handler;
232}
233
234/**
235 * irq_alloc_generic_chip - Allocate a generic chip and initialize it
236 * @name:	Name of the irq chip
237 * @num_ct:	Number of irq_chip_type instances associated with this
238 * @irq_base:	Interrupt base nr for this chip
239 * @reg_base:	Register base address (virtual)
240 * @handler:	Default flow handler associated with this chip
241 *
242 * Returns an initialized irq_chip_generic structure. The chip defaults
243 * to the primary (index 0) irq_chip_type and @handler
244 */
245struct irq_chip_generic *
246irq_alloc_generic_chip(const char *name, int num_ct, unsigned int irq_base,
247		       void __iomem *reg_base, irq_flow_handler_t handler)
248{
249	struct irq_chip_generic *gc;
250
251	gc = kzalloc(struct_size(gc, chip_types, num_ct), GFP_KERNEL);
252	if (gc) {
253		irq_init_generic_chip(gc, name, num_ct, irq_base, reg_base,
254				      handler);
255	}
256	return gc;
257}
258EXPORT_SYMBOL_GPL(irq_alloc_generic_chip);
259
260static void
261irq_gc_init_mask_cache(struct irq_chip_generic *gc, enum irq_gc_flags flags)
262{
263	struct irq_chip_type *ct = gc->chip_types;
264	u32 *mskptr = &gc->mask_cache, mskreg = ct->regs.mask;
265	int i;
266
267	for (i = 0; i < gc->num_ct; i++) {
268		if (flags & IRQ_GC_MASK_CACHE_PER_TYPE) {
269			mskptr = &ct[i].mask_cache_priv;
270			mskreg = ct[i].regs.mask;
271		}
272		ct[i].mask_cache = mskptr;
273		if (flags & IRQ_GC_INIT_MASK_CACHE)
274			*mskptr = irq_reg_readl(gc, mskreg);
275	}
276}
277
278/**
279 * __irq_alloc_domain_generic_chips - Allocate generic chips for an irq domain
280 * @d:			irq domain for which to allocate chips
281 * @irqs_per_chip:	Number of interrupts each chip handles (max 32)
282 * @num_ct:		Number of irq_chip_type instances associated with this
283 * @name:		Name of the irq chip
284 * @handler:		Default flow handler associated with these chips
285 * @clr:		IRQ_* bits to clear in the mapping function
286 * @set:		IRQ_* bits to set in the mapping function
287 * @gcflags:		Generic chip specific setup flags
288 */
289int __irq_alloc_domain_generic_chips(struct irq_domain *d, int irqs_per_chip,
290				     int num_ct, const char *name,
291				     irq_flow_handler_t handler,
292				     unsigned int clr, unsigned int set,
293				     enum irq_gc_flags gcflags)
294{
295	struct irq_domain_chip_generic *dgc;
296	struct irq_chip_generic *gc;
297	unsigned long flags;
298	int numchips, i;
299	size_t dgc_sz;
300	size_t gc_sz;
301	size_t sz;
302	void *tmp;
 
303
304	if (d->gc)
305		return -EBUSY;
306
307	numchips = DIV_ROUND_UP(d->revmap_size, irqs_per_chip);
308	if (!numchips)
309		return -EINVAL;
310
311	/* Allocate a pointer, generic chip and chiptypes for each chip */
312	gc_sz = struct_size(gc, chip_types, num_ct);
313	dgc_sz = struct_size(dgc, gc, numchips);
314	sz = dgc_sz + numchips * gc_sz;
315
316	tmp = dgc = kzalloc(sz, GFP_KERNEL);
317	if (!dgc)
318		return -ENOMEM;
319	dgc->irqs_per_chip = irqs_per_chip;
320	dgc->num_chips = numchips;
321	dgc->irq_flags_to_set = set;
322	dgc->irq_flags_to_clear = clr;
323	dgc->gc_flags = gcflags;
 
324	d->gc = dgc;
325
326	/* Calc pointer to the first generic chip */
327	tmp += dgc_sz;
328	for (i = 0; i < numchips; i++) {
329		/* Store the pointer to the generic chip */
330		dgc->gc[i] = gc = tmp;
331		irq_init_generic_chip(gc, name, num_ct, i * irqs_per_chip,
332				      NULL, handler);
 
333
334		gc->domain = d;
335		if (gcflags & IRQ_GC_BE_IO) {
336			gc->reg_readl = &irq_readl_be;
337			gc->reg_writel = &irq_writel_be;
338		}
339
 
 
 
 
 
 
340		raw_spin_lock_irqsave(&gc_lock, flags);
341		list_add_tail(&gc->list, &gc_list);
342		raw_spin_unlock_irqrestore(&gc_lock, flags);
343		/* Calc pointer to the next generic chip */
344		tmp += gc_sz;
345	}
346	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
347}
348EXPORT_SYMBOL_GPL(__irq_alloc_domain_generic_chips);
349
350static struct irq_chip_generic *
351__irq_get_domain_generic_chip(struct irq_domain *d, unsigned int hw_irq)
352{
353	struct irq_domain_chip_generic *dgc = d->gc;
354	int idx;
355
356	if (!dgc)
357		return ERR_PTR(-ENODEV);
358	idx = hw_irq / dgc->irqs_per_chip;
359	if (idx >= dgc->num_chips)
360		return ERR_PTR(-EINVAL);
361	return dgc->gc[idx];
362}
363
364/**
365 * irq_get_domain_generic_chip - Get a pointer to the generic chip of a hw_irq
366 * @d:			irq domain pointer
367 * @hw_irq:		Hardware interrupt number
368 */
369struct irq_chip_generic *
370irq_get_domain_generic_chip(struct irq_domain *d, unsigned int hw_irq)
371{
372	struct irq_chip_generic *gc = __irq_get_domain_generic_chip(d, hw_irq);
373
374	return !IS_ERR(gc) ? gc : NULL;
375}
376EXPORT_SYMBOL_GPL(irq_get_domain_generic_chip);
377
378/*
379 * Separate lockdep classes for interrupt chip which can nest irq_desc
380 * lock and request mutex.
381 */
382static struct lock_class_key irq_nested_lock_class;
383static struct lock_class_key irq_nested_request_class;
384
385/*
386 * irq_map_generic_chip - Map a generic chip for an irq domain
387 */
388int irq_map_generic_chip(struct irq_domain *d, unsigned int virq,
389			 irq_hw_number_t hw_irq)
390{
391	struct irq_data *data = irq_domain_get_irq_data(d, virq);
392	struct irq_domain_chip_generic *dgc = d->gc;
393	struct irq_chip_generic *gc;
394	struct irq_chip_type *ct;
395	struct irq_chip *chip;
396	unsigned long flags;
397	int idx;
398
399	gc = __irq_get_domain_generic_chip(d, hw_irq);
400	if (IS_ERR(gc))
401		return PTR_ERR(gc);
402
403	idx = hw_irq % dgc->irqs_per_chip;
404
405	if (test_bit(idx, &gc->unused))
406		return -ENOTSUPP;
407
408	if (test_bit(idx, &gc->installed))
409		return -EBUSY;
410
411	ct = gc->chip_types;
412	chip = &ct->chip;
413
414	/* We only init the cache for the first mapping of a generic chip */
415	if (!gc->installed) {
416		raw_spin_lock_irqsave(&gc->lock, flags);
417		irq_gc_init_mask_cache(gc, dgc->gc_flags);
418		raw_spin_unlock_irqrestore(&gc->lock, flags);
419	}
420
421	/* Mark the interrupt as installed */
422	set_bit(idx, &gc->installed);
423
424	if (dgc->gc_flags & IRQ_GC_INIT_NESTED_LOCK)
425		irq_set_lockdep_class(virq, &irq_nested_lock_class,
426				      &irq_nested_request_class);
427
428	if (chip->irq_calc_mask)
429		chip->irq_calc_mask(data);
430	else
431		data->mask = 1 << idx;
432
433	irq_domain_set_info(d, virq, hw_irq, chip, gc, ct->handler, NULL, NULL);
434	irq_modify_status(virq, dgc->irq_flags_to_clear, dgc->irq_flags_to_set);
435	return 0;
436}
437
438void irq_unmap_generic_chip(struct irq_domain *d, unsigned int virq)
439{
440	struct irq_data *data = irq_domain_get_irq_data(d, virq);
441	struct irq_domain_chip_generic *dgc = d->gc;
442	unsigned int hw_irq = data->hwirq;
443	struct irq_chip_generic *gc;
444	int irq_idx;
445
446	gc = irq_get_domain_generic_chip(d, hw_irq);
447	if (!gc)
448		return;
449
450	irq_idx = hw_irq % dgc->irqs_per_chip;
451
452	clear_bit(irq_idx, &gc->installed);
453	irq_domain_set_info(d, virq, hw_irq, &no_irq_chip, NULL, NULL, NULL,
454			    NULL);
455
456}
457
458const struct irq_domain_ops irq_generic_chip_ops = {
459	.map	= irq_map_generic_chip,
460	.unmap  = irq_unmap_generic_chip,
461	.xlate	= irq_domain_xlate_onetwocell,
462};
463EXPORT_SYMBOL_GPL(irq_generic_chip_ops);
464
465/**
466 * irq_setup_generic_chip - Setup a range of interrupts with a generic chip
467 * @gc:		Generic irq chip holding all data
468 * @msk:	Bitmask holding the irqs to initialize relative to gc->irq_base
469 * @flags:	Flags for initialization
470 * @clr:	IRQ_* bits to clear
471 * @set:	IRQ_* bits to set
472 *
473 * Set up max. 32 interrupts starting from gc->irq_base. Note, this
474 * initializes all interrupts to the primary irq_chip_type and its
475 * associated handler.
476 */
477void irq_setup_generic_chip(struct irq_chip_generic *gc, u32 msk,
478			    enum irq_gc_flags flags, unsigned int clr,
479			    unsigned int set)
480{
481	struct irq_chip_type *ct = gc->chip_types;
482	struct irq_chip *chip = &ct->chip;
483	unsigned int i;
484
485	raw_spin_lock(&gc_lock);
486	list_add_tail(&gc->list, &gc_list);
487	raw_spin_unlock(&gc_lock);
488
489	irq_gc_init_mask_cache(gc, flags);
490
491	for (i = gc->irq_base; msk; msk >>= 1, i++) {
492		if (!(msk & 0x01))
493			continue;
494
495		if (flags & IRQ_GC_INIT_NESTED_LOCK)
496			irq_set_lockdep_class(i, &irq_nested_lock_class,
497					      &irq_nested_request_class);
498
499		if (!(flags & IRQ_GC_NO_MASK)) {
500			struct irq_data *d = irq_get_irq_data(i);
501
502			if (chip->irq_calc_mask)
503				chip->irq_calc_mask(d);
504			else
505				d->mask = 1 << (i - gc->irq_base);
506		}
507		irq_set_chip_and_handler(i, chip, ct->handler);
508		irq_set_chip_data(i, gc);
509		irq_modify_status(i, clr, set);
510	}
511	gc->irq_cnt = i - gc->irq_base;
512}
513EXPORT_SYMBOL_GPL(irq_setup_generic_chip);
514
515/**
516 * irq_setup_alt_chip - Switch to alternative chip
517 * @d:		irq_data for this interrupt
518 * @type:	Flow type to be initialized
519 *
520 * Only to be called from chip->irq_set_type() callbacks.
521 */
522int irq_setup_alt_chip(struct irq_data *d, unsigned int type)
523{
524	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
525	struct irq_chip_type *ct = gc->chip_types;
526	unsigned int i;
527
528	for (i = 0; i < gc->num_ct; i++, ct++) {
529		if (ct->type & type) {
530			d->chip = &ct->chip;
531			irq_data_to_desc(d)->handle_irq = ct->handler;
532			return 0;
533		}
534	}
535	return -EINVAL;
536}
537EXPORT_SYMBOL_GPL(irq_setup_alt_chip);
538
539/**
540 * irq_remove_generic_chip - Remove a chip
541 * @gc:		Generic irq chip holding all data
542 * @msk:	Bitmask holding the irqs to initialize relative to gc->irq_base
543 * @clr:	IRQ_* bits to clear
544 * @set:	IRQ_* bits to set
545 *
546 * Remove up to 32 interrupts starting from gc->irq_base.
547 */
548void irq_remove_generic_chip(struct irq_chip_generic *gc, u32 msk,
549			     unsigned int clr, unsigned int set)
550{
551	unsigned int i, virq;
552
553	raw_spin_lock(&gc_lock);
554	list_del(&gc->list);
555	raw_spin_unlock(&gc_lock);
556
557	for (i = 0; msk; msk >>= 1, i++) {
558		if (!(msk & 0x01))
559			continue;
560
561		/*
562		 * Interrupt domain based chips store the base hardware
563		 * interrupt number in gc::irq_base. Otherwise gc::irq_base
564		 * contains the base Linux interrupt number.
565		 */
566		if (gc->domain) {
567			virq = irq_find_mapping(gc->domain, gc->irq_base + i);
568			if (!virq)
569				continue;
570		} else {
571			virq = gc->irq_base + i;
572		}
573
574		/* Remove handler first. That will mask the irq line */
575		irq_set_handler(virq, NULL);
576		irq_set_chip(virq, &no_irq_chip);
577		irq_set_chip_data(virq, NULL);
578		irq_modify_status(virq, clr, set);
579	}
580}
581EXPORT_SYMBOL_GPL(irq_remove_generic_chip);
582
583static struct irq_data *irq_gc_get_irq_data(struct irq_chip_generic *gc)
584{
585	unsigned int virq;
586
587	if (!gc->domain)
588		return irq_get_irq_data(gc->irq_base);
589
590	/*
591	 * We don't know which of the irqs has been actually
592	 * installed. Use the first one.
593	 */
594	if (!gc->installed)
595		return NULL;
596
597	virq = irq_find_mapping(gc->domain, gc->irq_base + __ffs(gc->installed));
598	return virq ? irq_get_irq_data(virq) : NULL;
599}
600
601#ifdef CONFIG_PM
602static int irq_gc_suspend(void)
603{
604	struct irq_chip_generic *gc;
605
606	list_for_each_entry(gc, &gc_list, list) {
607		struct irq_chip_type *ct = gc->chip_types;
608
609		if (ct->chip.irq_suspend) {
610			struct irq_data *data = irq_gc_get_irq_data(gc);
611
612			if (data)
613				ct->chip.irq_suspend(data);
614		}
615
616		if (gc->suspend)
617			gc->suspend(gc);
618	}
619	return 0;
620}
621
622static void irq_gc_resume(void)
623{
624	struct irq_chip_generic *gc;
625
626	list_for_each_entry(gc, &gc_list, list) {
627		struct irq_chip_type *ct = gc->chip_types;
628
629		if (gc->resume)
630			gc->resume(gc);
631
632		if (ct->chip.irq_resume) {
633			struct irq_data *data = irq_gc_get_irq_data(gc);
634
635			if (data)
636				ct->chip.irq_resume(data);
637		}
638	}
639}
640#else
641#define irq_gc_suspend NULL
642#define irq_gc_resume NULL
643#endif
644
645static void irq_gc_shutdown(void)
646{
647	struct irq_chip_generic *gc;
648
649	list_for_each_entry(gc, &gc_list, list) {
650		struct irq_chip_type *ct = gc->chip_types;
651
652		if (ct->chip.irq_pm_shutdown) {
653			struct irq_data *data = irq_gc_get_irq_data(gc);
654
655			if (data)
656				ct->chip.irq_pm_shutdown(data);
657		}
658	}
659}
660
661static struct syscore_ops irq_gc_syscore_ops = {
662	.suspend = irq_gc_suspend,
663	.resume = irq_gc_resume,
664	.shutdown = irq_gc_shutdown,
665};
666
667static int __init irq_gc_init_ops(void)
668{
669	register_syscore_ops(&irq_gc_syscore_ops);
670	return 0;
671}
672device_initcall(irq_gc_init_ops);
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Library implementing the most common irq chip callback functions
  4 *
  5 * Copyright (C) 2011, Thomas Gleixner
  6 */
  7#include <linux/io.h>
  8#include <linux/irq.h>
  9#include <linux/slab.h>
 10#include <linux/export.h>
 11#include <linux/irqdomain.h>
 12#include <linux/interrupt.h>
 13#include <linux/kernel_stat.h>
 14#include <linux/syscore_ops.h>
 15
 16#include "internals.h"
 17
 18static LIST_HEAD(gc_list);
 19static DEFINE_RAW_SPINLOCK(gc_lock);
 20
 21/**
 22 * irq_gc_noop - NOOP function
 23 * @d: irq_data
 24 */
 25void irq_gc_noop(struct irq_data *d)
 26{
 27}
 28EXPORT_SYMBOL_GPL(irq_gc_noop);
 29
 30/**
 31 * irq_gc_mask_disable_reg - Mask chip via disable register
 32 * @d: irq_data
 33 *
 34 * Chip has separate enable/disable registers instead of a single mask
 35 * register.
 36 */
 37void irq_gc_mask_disable_reg(struct irq_data *d)
 38{
 39	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
 40	struct irq_chip_type *ct = irq_data_get_chip_type(d);
 41	u32 mask = d->mask;
 42
 43	irq_gc_lock(gc);
 44	irq_reg_writel(gc, mask, ct->regs.disable);
 45	*ct->mask_cache &= ~mask;
 46	irq_gc_unlock(gc);
 47}
 48EXPORT_SYMBOL_GPL(irq_gc_mask_disable_reg);
 49
 50/**
 51 * irq_gc_mask_set_bit - Mask chip via setting bit in mask register
 52 * @d: irq_data
 53 *
 54 * Chip has a single mask register. Values of this register are cached
 55 * and protected by gc->lock
 56 */
 57void irq_gc_mask_set_bit(struct irq_data *d)
 58{
 59	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
 60	struct irq_chip_type *ct = irq_data_get_chip_type(d);
 61	u32 mask = d->mask;
 62
 63	irq_gc_lock(gc);
 64	*ct->mask_cache |= mask;
 65	irq_reg_writel(gc, *ct->mask_cache, ct->regs.mask);
 66	irq_gc_unlock(gc);
 67}
 68EXPORT_SYMBOL_GPL(irq_gc_mask_set_bit);
 69
 70/**
 71 * irq_gc_mask_clr_bit - Mask chip via clearing bit in mask register
 72 * @d: irq_data
 73 *
 74 * Chip has a single mask register. Values of this register are cached
 75 * and protected by gc->lock
 76 */
 77void irq_gc_mask_clr_bit(struct irq_data *d)
 78{
 79	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
 80	struct irq_chip_type *ct = irq_data_get_chip_type(d);
 81	u32 mask = d->mask;
 82
 83	irq_gc_lock(gc);
 84	*ct->mask_cache &= ~mask;
 85	irq_reg_writel(gc, *ct->mask_cache, ct->regs.mask);
 86	irq_gc_unlock(gc);
 87}
 88EXPORT_SYMBOL_GPL(irq_gc_mask_clr_bit);
 89
 90/**
 91 * irq_gc_unmask_enable_reg - Unmask chip via enable register
 92 * @d: irq_data
 93 *
 94 * Chip has separate enable/disable registers instead of a single mask
 95 * register.
 96 */
 97void irq_gc_unmask_enable_reg(struct irq_data *d)
 98{
 99	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
100	struct irq_chip_type *ct = irq_data_get_chip_type(d);
101	u32 mask = d->mask;
102
103	irq_gc_lock(gc);
104	irq_reg_writel(gc, mask, ct->regs.enable);
105	*ct->mask_cache |= mask;
106	irq_gc_unlock(gc);
107}
108EXPORT_SYMBOL_GPL(irq_gc_unmask_enable_reg);
109
110/**
111 * irq_gc_ack_set_bit - Ack pending interrupt via setting bit
112 * @d: irq_data
113 */
114void irq_gc_ack_set_bit(struct irq_data *d)
115{
116	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
117	struct irq_chip_type *ct = irq_data_get_chip_type(d);
118	u32 mask = d->mask;
119
120	irq_gc_lock(gc);
121	irq_reg_writel(gc, mask, ct->regs.ack);
122	irq_gc_unlock(gc);
123}
124EXPORT_SYMBOL_GPL(irq_gc_ack_set_bit);
125
126/**
127 * irq_gc_ack_clr_bit - Ack pending interrupt via clearing bit
128 * @d: irq_data
129 */
130void irq_gc_ack_clr_bit(struct irq_data *d)
131{
132	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
133	struct irq_chip_type *ct = irq_data_get_chip_type(d);
134	u32 mask = ~d->mask;
135
136	irq_gc_lock(gc);
137	irq_reg_writel(gc, mask, ct->regs.ack);
138	irq_gc_unlock(gc);
139}
140
141/**
142 * irq_gc_mask_disable_and_ack_set - Mask and ack pending interrupt
143 * @d: irq_data
144 *
145 * This generic implementation of the irq_mask_ack method is for chips
146 * with separate enable/disable registers instead of a single mask
147 * register and where a pending interrupt is acknowledged by setting a
148 * bit.
149 *
150 * Note: This is the only permutation currently used.  Similar generic
151 * functions should be added here if other permutations are required.
152 */
153void irq_gc_mask_disable_and_ack_set(struct irq_data *d)
154{
155	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
156	struct irq_chip_type *ct = irq_data_get_chip_type(d);
157	u32 mask = d->mask;
158
159	irq_gc_lock(gc);
160	irq_reg_writel(gc, mask, ct->regs.disable);
161	*ct->mask_cache &= ~mask;
162	irq_reg_writel(gc, mask, ct->regs.ack);
163	irq_gc_unlock(gc);
164}
165
166/**
167 * irq_gc_eoi - EOI interrupt
168 * @d: irq_data
169 */
170void irq_gc_eoi(struct irq_data *d)
171{
172	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
173	struct irq_chip_type *ct = irq_data_get_chip_type(d);
174	u32 mask = d->mask;
175
176	irq_gc_lock(gc);
177	irq_reg_writel(gc, mask, ct->regs.eoi);
178	irq_gc_unlock(gc);
179}
180
181/**
182 * irq_gc_set_wake - Set/clr wake bit for an interrupt
183 * @d:  irq_data
184 * @on: Indicates whether the wake bit should be set or cleared
185 *
186 * For chips where the wake from suspend functionality is not
187 * configured in a separate register and the wakeup active state is
188 * just stored in a bitmask.
189 */
190int irq_gc_set_wake(struct irq_data *d, unsigned int on)
191{
192	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
193	u32 mask = d->mask;
194
195	if (!(mask & gc->wake_enabled))
196		return -EINVAL;
197
198	irq_gc_lock(gc);
199	if (on)
200		gc->wake_active |= mask;
201	else
202		gc->wake_active &= ~mask;
203	irq_gc_unlock(gc);
204	return 0;
205}
206EXPORT_SYMBOL_GPL(irq_gc_set_wake);
207
208static u32 irq_readl_be(void __iomem *addr)
209{
210	return ioread32be(addr);
211}
212
213static void irq_writel_be(u32 val, void __iomem *addr)
214{
215	iowrite32be(val, addr);
216}
217
218void irq_init_generic_chip(struct irq_chip_generic *gc, const char *name,
219			   int num_ct, unsigned int irq_base,
220			   void __iomem *reg_base, irq_flow_handler_t handler)
221{
222	struct irq_chip_type *ct = gc->chip_types;
223	int i;
224
225	raw_spin_lock_init(&gc->lock);
226	gc->num_ct = num_ct;
227	gc->irq_base = irq_base;
228	gc->reg_base = reg_base;
229	for (i = 0; i < num_ct; i++)
230		ct[i].chip.name = name;
231	gc->chip_types->handler = handler;
232}
233
234/**
235 * irq_alloc_generic_chip - Allocate a generic chip and initialize it
236 * @name:	Name of the irq chip
237 * @num_ct:	Number of irq_chip_type instances associated with this
238 * @irq_base:	Interrupt base nr for this chip
239 * @reg_base:	Register base address (virtual)
240 * @handler:	Default flow handler associated with this chip
241 *
242 * Returns an initialized irq_chip_generic structure. The chip defaults
243 * to the primary (index 0) irq_chip_type and @handler
244 */
245struct irq_chip_generic *
246irq_alloc_generic_chip(const char *name, int num_ct, unsigned int irq_base,
247		       void __iomem *reg_base, irq_flow_handler_t handler)
248{
249	struct irq_chip_generic *gc;
250
251	gc = kzalloc(struct_size(gc, chip_types, num_ct), GFP_KERNEL);
252	if (gc) {
253		irq_init_generic_chip(gc, name, num_ct, irq_base, reg_base,
254				      handler);
255	}
256	return gc;
257}
258EXPORT_SYMBOL_GPL(irq_alloc_generic_chip);
259
260static void
261irq_gc_init_mask_cache(struct irq_chip_generic *gc, enum irq_gc_flags flags)
262{
263	struct irq_chip_type *ct = gc->chip_types;
264	u32 *mskptr = &gc->mask_cache, mskreg = ct->regs.mask;
265	int i;
266
267	for (i = 0; i < gc->num_ct; i++) {
268		if (flags & IRQ_GC_MASK_CACHE_PER_TYPE) {
269			mskptr = &ct[i].mask_cache_priv;
270			mskreg = ct[i].regs.mask;
271		}
272		ct[i].mask_cache = mskptr;
273		if (flags & IRQ_GC_INIT_MASK_CACHE)
274			*mskptr = irq_reg_readl(gc, mskreg);
275	}
276}
277
278/**
279 * irq_domain_alloc_generic_chips - Allocate generic chips for an irq domain
280 * @d:		irq domain for which to allocate chips
281 * @info:	Generic chip information
282 *
283 * Return: 0 on success, negative error code on failure
 
 
 
 
284 */
285int irq_domain_alloc_generic_chips(struct irq_domain *d,
286				   const struct irq_domain_chip_generic_info *info)
 
 
 
287{
288	struct irq_domain_chip_generic *dgc;
289	struct irq_chip_generic *gc;
290	unsigned long flags;
291	int numchips, i;
292	size_t dgc_sz;
293	size_t gc_sz;
294	size_t sz;
295	void *tmp;
296	int ret;
297
298	if (d->gc)
299		return -EBUSY;
300
301	numchips = DIV_ROUND_UP(d->revmap_size, info->irqs_per_chip);
302	if (!numchips)
303		return -EINVAL;
304
305	/* Allocate a pointer, generic chip and chiptypes for each chip */
306	gc_sz = struct_size(gc, chip_types, info->num_ct);
307	dgc_sz = struct_size(dgc, gc, numchips);
308	sz = dgc_sz + numchips * gc_sz;
309
310	tmp = dgc = kzalloc(sz, GFP_KERNEL);
311	if (!dgc)
312		return -ENOMEM;
313	dgc->irqs_per_chip = info->irqs_per_chip;
314	dgc->num_chips = numchips;
315	dgc->irq_flags_to_set = info->irq_flags_to_set;
316	dgc->irq_flags_to_clear = info->irq_flags_to_clear;
317	dgc->gc_flags = info->gc_flags;
318	dgc->exit = info->exit;
319	d->gc = dgc;
320
321	/* Calc pointer to the first generic chip */
322	tmp += dgc_sz;
323	for (i = 0; i < numchips; i++) {
324		/* Store the pointer to the generic chip */
325		dgc->gc[i] = gc = tmp;
326		irq_init_generic_chip(gc, info->name, info->num_ct,
327				      i * dgc->irqs_per_chip, NULL,
328				      info->handler);
329
330		gc->domain = d;
331		if (dgc->gc_flags & IRQ_GC_BE_IO) {
332			gc->reg_readl = &irq_readl_be;
333			gc->reg_writel = &irq_writel_be;
334		}
335
336		if (info->init) {
337			ret = info->init(gc);
338			if (ret)
339				goto err;
340		}
341
342		raw_spin_lock_irqsave(&gc_lock, flags);
343		list_add_tail(&gc->list, &gc_list);
344		raw_spin_unlock_irqrestore(&gc_lock, flags);
345		/* Calc pointer to the next generic chip */
346		tmp += gc_sz;
347	}
348	return 0;
349
350err:
351	while (i--) {
352		if (dgc->exit)
353			dgc->exit(dgc->gc[i]);
354		irq_remove_generic_chip(dgc->gc[i], ~0U, 0, 0);
355	}
356	d->gc = NULL;
357	kfree(dgc);
358	return ret;
359}
360EXPORT_SYMBOL_GPL(irq_domain_alloc_generic_chips);
361
362/**
363 * irq_domain_remove_generic_chips - Remove generic chips from an irq domain
364 * @d: irq domain for which generic chips are to be removed
365 */
366void irq_domain_remove_generic_chips(struct irq_domain *d)
367{
368	struct irq_domain_chip_generic *dgc = d->gc;
369	unsigned int i;
370
371	if (!dgc)
372		return;
373
374	for (i = 0; i < dgc->num_chips; i++) {
375		if (dgc->exit)
376			dgc->exit(dgc->gc[i]);
377		irq_remove_generic_chip(dgc->gc[i], ~0U, 0, 0);
378	}
379	d->gc = NULL;
380	kfree(dgc);
381}
382EXPORT_SYMBOL_GPL(irq_domain_remove_generic_chips);
383
384/**
385 * __irq_alloc_domain_generic_chips - Allocate generic chips for an irq domain
386 * @d:			irq domain for which to allocate chips
387 * @irqs_per_chip:	Number of interrupts each chip handles (max 32)
388 * @num_ct:		Number of irq_chip_type instances associated with this
389 * @name:		Name of the irq chip
390 * @handler:		Default flow handler associated with these chips
391 * @clr:		IRQ_* bits to clear in the mapping function
392 * @set:		IRQ_* bits to set in the mapping function
393 * @gcflags:		Generic chip specific setup flags
394 */
395int __irq_alloc_domain_generic_chips(struct irq_domain *d, int irqs_per_chip,
396				     int num_ct, const char *name,
397				     irq_flow_handler_t handler,
398				     unsigned int clr, unsigned int set,
399				     enum irq_gc_flags gcflags)
400{
401	struct irq_domain_chip_generic_info info = {
402		.irqs_per_chip		= irqs_per_chip,
403		.num_ct			= num_ct,
404		.name			= name,
405		.handler		= handler,
406		.irq_flags_to_clear	= clr,
407		.irq_flags_to_set	= set,
408		.gc_flags		= gcflags,
409	};
410
411	return irq_domain_alloc_generic_chips(d, &info);
412}
413EXPORT_SYMBOL_GPL(__irq_alloc_domain_generic_chips);
414
415static struct irq_chip_generic *
416__irq_get_domain_generic_chip(struct irq_domain *d, unsigned int hw_irq)
417{
418	struct irq_domain_chip_generic *dgc = d->gc;
419	int idx;
420
421	if (!dgc)
422		return ERR_PTR(-ENODEV);
423	idx = hw_irq / dgc->irqs_per_chip;
424	if (idx >= dgc->num_chips)
425		return ERR_PTR(-EINVAL);
426	return dgc->gc[idx];
427}
428
429/**
430 * irq_get_domain_generic_chip - Get a pointer to the generic chip of a hw_irq
431 * @d:			irq domain pointer
432 * @hw_irq:		Hardware interrupt number
433 */
434struct irq_chip_generic *
435irq_get_domain_generic_chip(struct irq_domain *d, unsigned int hw_irq)
436{
437	struct irq_chip_generic *gc = __irq_get_domain_generic_chip(d, hw_irq);
438
439	return !IS_ERR(gc) ? gc : NULL;
440}
441EXPORT_SYMBOL_GPL(irq_get_domain_generic_chip);
442
443/*
444 * Separate lockdep classes for interrupt chip which can nest irq_desc
445 * lock and request mutex.
446 */
447static struct lock_class_key irq_nested_lock_class;
448static struct lock_class_key irq_nested_request_class;
449
450/*
451 * irq_map_generic_chip - Map a generic chip for an irq domain
452 */
453int irq_map_generic_chip(struct irq_domain *d, unsigned int virq,
454			 irq_hw_number_t hw_irq)
455{
456	struct irq_data *data = irq_domain_get_irq_data(d, virq);
457	struct irq_domain_chip_generic *dgc = d->gc;
458	struct irq_chip_generic *gc;
459	struct irq_chip_type *ct;
460	struct irq_chip *chip;
461	unsigned long flags;
462	int idx;
463
464	gc = __irq_get_domain_generic_chip(d, hw_irq);
465	if (IS_ERR(gc))
466		return PTR_ERR(gc);
467
468	idx = hw_irq % dgc->irqs_per_chip;
469
470	if (test_bit(idx, &gc->unused))
471		return -ENOTSUPP;
472
473	if (test_bit(idx, &gc->installed))
474		return -EBUSY;
475
476	ct = gc->chip_types;
477	chip = &ct->chip;
478
479	/* We only init the cache for the first mapping of a generic chip */
480	if (!gc->installed) {
481		raw_spin_lock_irqsave(&gc->lock, flags);
482		irq_gc_init_mask_cache(gc, dgc->gc_flags);
483		raw_spin_unlock_irqrestore(&gc->lock, flags);
484	}
485
486	/* Mark the interrupt as installed */
487	set_bit(idx, &gc->installed);
488
489	if (dgc->gc_flags & IRQ_GC_INIT_NESTED_LOCK)
490		irq_set_lockdep_class(virq, &irq_nested_lock_class,
491				      &irq_nested_request_class);
492
493	if (chip->irq_calc_mask)
494		chip->irq_calc_mask(data);
495	else
496		data->mask = 1 << idx;
497
498	irq_domain_set_info(d, virq, hw_irq, chip, gc, ct->handler, NULL, NULL);
499	irq_modify_status(virq, dgc->irq_flags_to_clear, dgc->irq_flags_to_set);
500	return 0;
501}
502
503void irq_unmap_generic_chip(struct irq_domain *d, unsigned int virq)
504{
505	struct irq_data *data = irq_domain_get_irq_data(d, virq);
506	struct irq_domain_chip_generic *dgc = d->gc;
507	unsigned int hw_irq = data->hwirq;
508	struct irq_chip_generic *gc;
509	int irq_idx;
510
511	gc = irq_get_domain_generic_chip(d, hw_irq);
512	if (!gc)
513		return;
514
515	irq_idx = hw_irq % dgc->irqs_per_chip;
516
517	clear_bit(irq_idx, &gc->installed);
518	irq_domain_set_info(d, virq, hw_irq, &no_irq_chip, NULL, NULL, NULL,
519			    NULL);
520
521}
522
523const struct irq_domain_ops irq_generic_chip_ops = {
524	.map	= irq_map_generic_chip,
525	.unmap  = irq_unmap_generic_chip,
526	.xlate	= irq_domain_xlate_onetwocell,
527};
528EXPORT_SYMBOL_GPL(irq_generic_chip_ops);
529
530/**
531 * irq_setup_generic_chip - Setup a range of interrupts with a generic chip
532 * @gc:		Generic irq chip holding all data
533 * @msk:	Bitmask holding the irqs to initialize relative to gc->irq_base
534 * @flags:	Flags for initialization
535 * @clr:	IRQ_* bits to clear
536 * @set:	IRQ_* bits to set
537 *
538 * Set up max. 32 interrupts starting from gc->irq_base. Note, this
539 * initializes all interrupts to the primary irq_chip_type and its
540 * associated handler.
541 */
542void irq_setup_generic_chip(struct irq_chip_generic *gc, u32 msk,
543			    enum irq_gc_flags flags, unsigned int clr,
544			    unsigned int set)
545{
546	struct irq_chip_type *ct = gc->chip_types;
547	struct irq_chip *chip = &ct->chip;
548	unsigned int i;
549
550	raw_spin_lock(&gc_lock);
551	list_add_tail(&gc->list, &gc_list);
552	raw_spin_unlock(&gc_lock);
553
554	irq_gc_init_mask_cache(gc, flags);
555
556	for (i = gc->irq_base; msk; msk >>= 1, i++) {
557		if (!(msk & 0x01))
558			continue;
559
560		if (flags & IRQ_GC_INIT_NESTED_LOCK)
561			irq_set_lockdep_class(i, &irq_nested_lock_class,
562					      &irq_nested_request_class);
563
564		if (!(flags & IRQ_GC_NO_MASK)) {
565			struct irq_data *d = irq_get_irq_data(i);
566
567			if (chip->irq_calc_mask)
568				chip->irq_calc_mask(d);
569			else
570				d->mask = 1 << (i - gc->irq_base);
571		}
572		irq_set_chip_and_handler(i, chip, ct->handler);
573		irq_set_chip_data(i, gc);
574		irq_modify_status(i, clr, set);
575	}
576	gc->irq_cnt = i - gc->irq_base;
577}
578EXPORT_SYMBOL_GPL(irq_setup_generic_chip);
579
580/**
581 * irq_setup_alt_chip - Switch to alternative chip
582 * @d:		irq_data for this interrupt
583 * @type:	Flow type to be initialized
584 *
585 * Only to be called from chip->irq_set_type() callbacks.
586 */
587int irq_setup_alt_chip(struct irq_data *d, unsigned int type)
588{
589	struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
590	struct irq_chip_type *ct = gc->chip_types;
591	unsigned int i;
592
593	for (i = 0; i < gc->num_ct; i++, ct++) {
594		if (ct->type & type) {
595			d->chip = &ct->chip;
596			irq_data_to_desc(d)->handle_irq = ct->handler;
597			return 0;
598		}
599	}
600	return -EINVAL;
601}
602EXPORT_SYMBOL_GPL(irq_setup_alt_chip);
603
604/**
605 * irq_remove_generic_chip - Remove a chip
606 * @gc:		Generic irq chip holding all data
607 * @msk:	Bitmask holding the irqs to initialize relative to gc->irq_base
608 * @clr:	IRQ_* bits to clear
609 * @set:	IRQ_* bits to set
610 *
611 * Remove up to 32 interrupts starting from gc->irq_base.
612 */
613void irq_remove_generic_chip(struct irq_chip_generic *gc, u32 msk,
614			     unsigned int clr, unsigned int set)
615{
616	unsigned int i, virq;
617
618	raw_spin_lock(&gc_lock);
619	list_del(&gc->list);
620	raw_spin_unlock(&gc_lock);
621
622	for (i = 0; msk; msk >>= 1, i++) {
623		if (!(msk & 0x01))
624			continue;
625
626		/*
627		 * Interrupt domain based chips store the base hardware
628		 * interrupt number in gc::irq_base. Otherwise gc::irq_base
629		 * contains the base Linux interrupt number.
630		 */
631		if (gc->domain) {
632			virq = irq_find_mapping(gc->domain, gc->irq_base + i);
633			if (!virq)
634				continue;
635		} else {
636			virq = gc->irq_base + i;
637		}
638
639		/* Remove handler first. That will mask the irq line */
640		irq_set_handler(virq, NULL);
641		irq_set_chip(virq, &no_irq_chip);
642		irq_set_chip_data(virq, NULL);
643		irq_modify_status(virq, clr, set);
644	}
645}
646EXPORT_SYMBOL_GPL(irq_remove_generic_chip);
647
648static struct irq_data *irq_gc_get_irq_data(struct irq_chip_generic *gc)
649{
650	unsigned int virq;
651
652	if (!gc->domain)
653		return irq_get_irq_data(gc->irq_base);
654
655	/*
656	 * We don't know which of the irqs has been actually
657	 * installed. Use the first one.
658	 */
659	if (!gc->installed)
660		return NULL;
661
662	virq = irq_find_mapping(gc->domain, gc->irq_base + __ffs(gc->installed));
663	return virq ? irq_get_irq_data(virq) : NULL;
664}
665
666#ifdef CONFIG_PM
667static int irq_gc_suspend(void)
668{
669	struct irq_chip_generic *gc;
670
671	list_for_each_entry(gc, &gc_list, list) {
672		struct irq_chip_type *ct = gc->chip_types;
673
674		if (ct->chip.irq_suspend) {
675			struct irq_data *data = irq_gc_get_irq_data(gc);
676
677			if (data)
678				ct->chip.irq_suspend(data);
679		}
680
681		if (gc->suspend)
682			gc->suspend(gc);
683	}
684	return 0;
685}
686
687static void irq_gc_resume(void)
688{
689	struct irq_chip_generic *gc;
690
691	list_for_each_entry(gc, &gc_list, list) {
692		struct irq_chip_type *ct = gc->chip_types;
693
694		if (gc->resume)
695			gc->resume(gc);
696
697		if (ct->chip.irq_resume) {
698			struct irq_data *data = irq_gc_get_irq_data(gc);
699
700			if (data)
701				ct->chip.irq_resume(data);
702		}
703	}
704}
705#else
706#define irq_gc_suspend NULL
707#define irq_gc_resume NULL
708#endif
709
710static void irq_gc_shutdown(void)
711{
712	struct irq_chip_generic *gc;
713
714	list_for_each_entry(gc, &gc_list, list) {
715		struct irq_chip_type *ct = gc->chip_types;
716
717		if (ct->chip.irq_pm_shutdown) {
718			struct irq_data *data = irq_gc_get_irq_data(gc);
719
720			if (data)
721				ct->chip.irq_pm_shutdown(data);
722		}
723	}
724}
725
726static struct syscore_ops irq_gc_syscore_ops = {
727	.suspend = irq_gc_suspend,
728	.resume = irq_gc_resume,
729	.shutdown = irq_gc_shutdown,
730};
731
732static int __init irq_gc_init_ops(void)
733{
734	register_syscore_ops(&irq_gc_syscore_ops);
735	return 0;
736}
737device_initcall(irq_gc_init_ops);