1#define pr_fmt(fmt) "irq: " fmt
2
3#include <linux/debugfs.h>
4#include <linux/hardirq.h>
5#include <linux/interrupt.h>
6#include <linux/irq.h>
7#include <linux/irqdesc.h>
8#include <linux/irqdomain.h>
9#include <linux/module.h>
10#include <linux/mutex.h>
11#include <linux/of.h>
12#include <linux/of_address.h>
13#include <linux/of_irq.h>
14#include <linux/topology.h>
15#include <linux/seq_file.h>
16#include <linux/slab.h>
17#include <linux/smp.h>
18#include <linux/fs.h>
19
20static LIST_HEAD(irq_domain_list);
21static DEFINE_MUTEX(irq_domain_mutex);
22
23static DEFINE_MUTEX(revmap_trees_mutex);
24static struct irq_domain *irq_default_domain;
25
26static int irq_domain_alloc_descs(int virq, unsigned int nr_irqs,
27 irq_hw_number_t hwirq, int node);
28static void irq_domain_check_hierarchy(struct irq_domain *domain);
29
30struct irqchip_fwid {
31 struct fwnode_handle fwnode;
32 char *name;
33 void *data;
34};
35
36
37
38
39
40
41
42
43
44struct fwnode_handle *irq_domain_alloc_fwnode(void *data)
45{
46 struct irqchip_fwid *fwid;
47 char *name;
48
49 fwid = kzalloc(sizeof(*fwid), GFP_KERNEL);
50 name = kasprintf(GFP_KERNEL, "irqchip@%p", data);
51
52 if (!fwid || !name) {
53 kfree(fwid);
54 kfree(name);
55 return NULL;
56 }
57
58 fwid->name = name;
59 fwid->data = data;
60 fwid->fwnode.type = FWNODE_IRQCHIP;
61 return &fwid->fwnode;
62}
63EXPORT_SYMBOL_GPL(irq_domain_alloc_fwnode);
64
65
66
67
68
69
70void irq_domain_free_fwnode(struct fwnode_handle *fwnode)
71{
72 struct irqchip_fwid *fwid;
73
74 if (WARN_ON(!is_fwnode_irqchip(fwnode)))
75 return;
76
77 fwid = container_of(fwnode, struct irqchip_fwid, fwnode);
78 kfree(fwid->name);
79 kfree(fwid);
80}
81EXPORT_SYMBOL_GPL(irq_domain_free_fwnode);
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96struct irq_domain *__irq_domain_add(struct fwnode_handle *fwnode, int size,
97 irq_hw_number_t hwirq_max, int direct_max,
98 const struct irq_domain_ops *ops,
99 void *host_data)
100{
101 struct irq_domain *domain;
102 struct device_node *of_node;
103
104 of_node = to_of_node(fwnode);
105
106 domain = kzalloc_node(sizeof(*domain) + (sizeof(unsigned int) * size),
107 GFP_KERNEL, of_node_to_nid(of_node));
108 if (WARN_ON(!domain))
109 return NULL;
110
111 of_node_get(of_node);
112
113
114 INIT_RADIX_TREE(&domain->revmap_tree, GFP_KERNEL);
115 domain->ops = ops;
116 domain->host_data = host_data;
117 domain->fwnode = fwnode;
118 domain->hwirq_max = hwirq_max;
119 domain->revmap_size = size;
120 domain->revmap_direct_max_irq = direct_max;
121 irq_domain_check_hierarchy(domain);
122
123 mutex_lock(&irq_domain_mutex);
124 list_add(&domain->link, &irq_domain_list);
125 mutex_unlock(&irq_domain_mutex);
126
127 pr_debug("Added domain %s\n", domain->name);
128 return domain;
129}
130EXPORT_SYMBOL_GPL(__irq_domain_add);
131
132
133
134
135
136
137
138
139
140void irq_domain_remove(struct irq_domain *domain)
141{
142 mutex_lock(&irq_domain_mutex);
143
144
145
146
147
148
149 WARN_ON(domain->revmap_tree.height);
150
151 list_del(&domain->link);
152
153
154
155
156 if (unlikely(irq_default_domain == domain))
157 irq_set_default_host(NULL);
158
159 mutex_unlock(&irq_domain_mutex);
160
161 pr_debug("Removed domain %s\n", domain->name);
162
163 of_node_put(irq_domain_get_of_node(domain));
164 kfree(domain);
165}
166EXPORT_SYMBOL_GPL(irq_domain_remove);
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186struct irq_domain *irq_domain_add_simple(struct device_node *of_node,
187 unsigned int size,
188 unsigned int first_irq,
189 const struct irq_domain_ops *ops,
190 void *host_data)
191{
192 struct irq_domain *domain;
193
194 domain = __irq_domain_add(of_node_to_fwnode(of_node), size, size, 0, ops, host_data);
195 if (!domain)
196 return NULL;
197
198 if (first_irq > 0) {
199 if (IS_ENABLED(CONFIG_SPARSE_IRQ)) {
200
201 int rc = irq_alloc_descs(first_irq, first_irq, size,
202 of_node_to_nid(of_node));
203 if (rc < 0)
204 pr_info("Cannot allocate irq_descs @ IRQ%d, assuming pre-allocated\n",
205 first_irq);
206 }
207 irq_domain_associate_many(domain, first_irq, 0, size);
208 }
209
210 return domain;
211}
212EXPORT_SYMBOL_GPL(irq_domain_add_simple);
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229struct irq_domain *irq_domain_add_legacy(struct device_node *of_node,
230 unsigned int size,
231 unsigned int first_irq,
232 irq_hw_number_t first_hwirq,
233 const struct irq_domain_ops *ops,
234 void *host_data)
235{
236 struct irq_domain *domain;
237
238 domain = __irq_domain_add(of_node_to_fwnode(of_node), first_hwirq + size,
239 first_hwirq + size, 0, ops, host_data);
240 if (domain)
241 irq_domain_associate_many(domain, first_irq, first_hwirq, size);
242
243 return domain;
244}
245EXPORT_SYMBOL_GPL(irq_domain_add_legacy);
246
247
248
249
250
251
252struct irq_domain *irq_find_matching_fwnode(struct fwnode_handle *fwnode,
253 enum irq_domain_bus_token bus_token)
254{
255 struct irq_domain *h, *found = NULL;
256 int rc;
257
258
259
260
261
262
263
264
265
266
267 mutex_lock(&irq_domain_mutex);
268 list_for_each_entry(h, &irq_domain_list, link) {
269 if (h->ops->match)
270 rc = h->ops->match(h, to_of_node(fwnode), bus_token);
271 else
272 rc = ((fwnode != NULL) && (h->fwnode == fwnode) &&
273 ((bus_token == DOMAIN_BUS_ANY) ||
274 (h->bus_token == bus_token)));
275
276 if (rc) {
277 found = h;
278 break;
279 }
280 }
281 mutex_unlock(&irq_domain_mutex);
282 return found;
283}
284EXPORT_SYMBOL_GPL(irq_find_matching_fwnode);
285
286
287
288
289
290
291
292
293
294
295void irq_set_default_host(struct irq_domain *domain)
296{
297 pr_debug("Default domain set to @0x%p\n", domain);
298
299 irq_default_domain = domain;
300}
301EXPORT_SYMBOL_GPL(irq_set_default_host);
302
303void irq_domain_disassociate(struct irq_domain *domain, unsigned int irq)
304{
305 struct irq_data *irq_data = irq_get_irq_data(irq);
306 irq_hw_number_t hwirq;
307
308 if (WARN(!irq_data || irq_data->domain != domain,
309 "virq%i doesn't exist; cannot disassociate\n", irq))
310 return;
311
312 hwirq = irq_data->hwirq;
313 irq_set_status_flags(irq, IRQ_NOREQUEST);
314
315
316 irq_set_chip_and_handler(irq, NULL, NULL);
317
318
319 synchronize_irq(irq);
320
321
322 if (domain->ops->unmap)
323 domain->ops->unmap(domain, irq);
324 smp_mb();
325
326 irq_data->domain = NULL;
327 irq_data->hwirq = 0;
328
329
330 if (hwirq < domain->revmap_size) {
331 domain->linear_revmap[hwirq] = 0;
332 } else {
333 mutex_lock(&revmap_trees_mutex);
334 radix_tree_delete(&domain->revmap_tree, hwirq);
335 mutex_unlock(&revmap_trees_mutex);
336 }
337}
338
339int irq_domain_associate(struct irq_domain *domain, unsigned int virq,
340 irq_hw_number_t hwirq)
341{
342 struct irq_data *irq_data = irq_get_irq_data(virq);
343 int ret;
344
345 if (WARN(hwirq >= domain->hwirq_max,
346 "error: hwirq 0x%x is too large for %s\n", (int)hwirq, domain->name))
347 return -EINVAL;
348 if (WARN(!irq_data, "error: virq%i is not allocated", virq))
349 return -EINVAL;
350 if (WARN(irq_data->domain, "error: virq%i is already associated", virq))
351 return -EINVAL;
352
353 mutex_lock(&irq_domain_mutex);
354 irq_data->hwirq = hwirq;
355 irq_data->domain = domain;
356 if (domain->ops->map) {
357 ret = domain->ops->map(domain, virq, hwirq);
358 if (ret != 0) {
359
360
361
362
363
364 if (ret != -EPERM) {
365 pr_info("%s didn't like hwirq-0x%lx to VIRQ%i mapping (rc=%d)\n",
366 domain->name, hwirq, virq, ret);
367 }
368 irq_data->domain = NULL;
369 irq_data->hwirq = 0;
370 mutex_unlock(&irq_domain_mutex);
371 return ret;
372 }
373
374
375 if (!domain->name && irq_data->chip)
376 domain->name = irq_data->chip->name;
377 }
378
379 if (hwirq < domain->revmap_size) {
380 domain->linear_revmap[hwirq] = virq;
381 } else {
382 mutex_lock(&revmap_trees_mutex);
383 radix_tree_insert(&domain->revmap_tree, hwirq, irq_data);
384 mutex_unlock(&revmap_trees_mutex);
385 }
386 mutex_unlock(&irq_domain_mutex);
387
388 irq_clear_status_flags(virq, IRQ_NOREQUEST);
389
390 return 0;
391}
392EXPORT_SYMBOL_GPL(irq_domain_associate);
393
394void irq_domain_associate_many(struct irq_domain *domain, unsigned int irq_base,
395 irq_hw_number_t hwirq_base, int count)
396{
397 struct device_node *of_node;
398 int i;
399
400 of_node = irq_domain_get_of_node(domain);
401 pr_debug("%s(%s, irqbase=%i, hwbase=%i, count=%i)\n", __func__,
402 of_node_full_name(of_node), irq_base, (int)hwirq_base, count);
403
404 for (i = 0; i < count; i++) {
405 irq_domain_associate(domain, irq_base + i, hwirq_base + i);
406 }
407}
408EXPORT_SYMBOL_GPL(irq_domain_associate_many);
409
410
411
412
413
414
415
416
417
418
419
420unsigned int irq_create_direct_mapping(struct irq_domain *domain)
421{
422 struct device_node *of_node;
423 unsigned int virq;
424
425 if (domain == NULL)
426 domain = irq_default_domain;
427
428 of_node = irq_domain_get_of_node(domain);
429 virq = irq_alloc_desc_from(1, of_node_to_nid(of_node));
430 if (!virq) {
431 pr_debug("create_direct virq allocation failed\n");
432 return 0;
433 }
434 if (virq >= domain->revmap_direct_max_irq) {
435 pr_err("ERROR: no free irqs available below %i maximum\n",
436 domain->revmap_direct_max_irq);
437 irq_free_desc(virq);
438 return 0;
439 }
440 pr_debug("create_direct obtained virq %d\n", virq);
441
442 if (irq_domain_associate(domain, virq, virq)) {
443 irq_free_desc(virq);
444 return 0;
445 }
446
447 return virq;
448}
449EXPORT_SYMBOL_GPL(irq_create_direct_mapping);
450
451
452
453
454
455
456
457
458
459
460
461unsigned int irq_create_mapping(struct irq_domain *domain,
462 irq_hw_number_t hwirq)
463{
464 struct device_node *of_node;
465 int virq;
466
467 pr_debug("irq_create_mapping(0x%p, 0x%lx)\n", domain, hwirq);
468
469
470 if (domain == NULL)
471 domain = irq_default_domain;
472 if (domain == NULL) {
473 WARN(1, "%s(, %lx) called with NULL domain\n", __func__, hwirq);
474 return 0;
475 }
476 pr_debug("-> using domain @%p\n", domain);
477
478 of_node = irq_domain_get_of_node(domain);
479
480
481 virq = irq_find_mapping(domain, hwirq);
482 if (virq) {
483 pr_debug("-> existing mapping on virq %d\n", virq);
484 return virq;
485 }
486
487
488 virq = irq_domain_alloc_descs(-1, 1, hwirq, of_node_to_nid(of_node));
489 if (virq <= 0) {
490 pr_debug("-> virq allocation failed\n");
491 return 0;
492 }
493
494 if (irq_domain_associate(domain, virq, hwirq)) {
495 irq_free_desc(virq);
496 return 0;
497 }
498
499 pr_debug("irq %lu on domain %s mapped to virtual irq %u\n",
500 hwirq, of_node_full_name(of_node), virq);
501
502 return virq;
503}
504EXPORT_SYMBOL_GPL(irq_create_mapping);
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524int irq_create_strict_mappings(struct irq_domain *domain, unsigned int irq_base,
525 irq_hw_number_t hwirq_base, int count)
526{
527 struct device_node *of_node;
528 int ret;
529
530 of_node = irq_domain_get_of_node(domain);
531 ret = irq_alloc_descs(irq_base, irq_base, count,
532 of_node_to_nid(of_node));
533 if (unlikely(ret < 0))
534 return ret;
535
536 irq_domain_associate_many(domain, irq_base, hwirq_base, count);
537 return 0;
538}
539EXPORT_SYMBOL_GPL(irq_create_strict_mappings);
540
541static int irq_domain_translate(struct irq_domain *d,
542 struct irq_fwspec *fwspec,
543 irq_hw_number_t *hwirq, unsigned int *type)
544{
545#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
546 if (d->ops->translate)
547 return d->ops->translate(d, fwspec, hwirq, type);
548#endif
549 if (d->ops->xlate)
550 return d->ops->xlate(d, to_of_node(fwspec->fwnode),
551 fwspec->param, fwspec->param_count,
552 hwirq, type);
553
554
555 *hwirq = fwspec->param[0];
556 return 0;
557}
558
559static void of_phandle_args_to_fwspec(struct of_phandle_args *irq_data,
560 struct irq_fwspec *fwspec)
561{
562 int i;
563
564 fwspec->fwnode = irq_data->np ? &irq_data->np->fwnode : NULL;
565 fwspec->param_count = irq_data->args_count;
566
567 for (i = 0; i < irq_data->args_count; i++)
568 fwspec->param[i] = irq_data->args[i];
569}
570
571unsigned int irq_create_fwspec_mapping(struct irq_fwspec *fwspec)
572{
573 struct irq_domain *domain;
574 irq_hw_number_t hwirq;
575 unsigned int type = IRQ_TYPE_NONE;
576 int virq;
577
578 if (fwspec->fwnode) {
579 domain = irq_find_matching_fwnode(fwspec->fwnode,
580 DOMAIN_BUS_WIRED);
581 if (!domain)
582 domain = irq_find_matching_fwnode(fwspec->fwnode,
583 DOMAIN_BUS_ANY);
584 } else {
585 domain = irq_default_domain;
586 }
587
588 if (!domain) {
589 pr_warn("no irq domain found for %s !\n",
590 of_node_full_name(to_of_node(fwspec->fwnode)));
591 return 0;
592 }
593
594 if (irq_domain_translate(domain, fwspec, &hwirq, &type))
595 return 0;
596
597 if (irq_domain_is_hierarchy(domain)) {
598
599
600
601
602 virq = irq_find_mapping(domain, hwirq);
603 if (virq)
604 return virq;
605
606 virq = irq_domain_alloc_irqs(domain, 1, NUMA_NO_NODE, fwspec);
607 if (virq <= 0)
608 return 0;
609 } else {
610
611 virq = irq_create_mapping(domain, hwirq);
612 if (!virq)
613 return virq;
614 }
615
616
617 if (type != IRQ_TYPE_NONE &&
618 type != irq_get_trigger_type(virq))
619 irq_set_irq_type(virq, type);
620 return virq;
621}
622EXPORT_SYMBOL_GPL(irq_create_fwspec_mapping);
623
624unsigned int irq_create_of_mapping(struct of_phandle_args *irq_data)
625{
626 struct irq_fwspec fwspec;
627
628 of_phandle_args_to_fwspec(irq_data, &fwspec);
629 return irq_create_fwspec_mapping(&fwspec);
630}
631EXPORT_SYMBOL_GPL(irq_create_of_mapping);
632
633
634
635
636
637void irq_dispose_mapping(unsigned int virq)
638{
639 struct irq_data *irq_data = irq_get_irq_data(virq);
640 struct irq_domain *domain;
641
642 if (!virq || !irq_data)
643 return;
644
645 domain = irq_data->domain;
646 if (WARN_ON(domain == NULL))
647 return;
648
649 irq_domain_disassociate(domain, virq);
650 irq_free_desc(virq);
651}
652EXPORT_SYMBOL_GPL(irq_dispose_mapping);
653
654
655
656
657
658
659unsigned int irq_find_mapping(struct irq_domain *domain,
660 irq_hw_number_t hwirq)
661{
662 struct irq_data *data;
663
664
665 if (domain == NULL)
666 domain = irq_default_domain;
667 if (domain == NULL)
668 return 0;
669
670 if (hwirq < domain->revmap_direct_max_irq) {
671 data = irq_domain_get_irq_data(domain, hwirq);
672 if (data && data->hwirq == hwirq)
673 return hwirq;
674 }
675
676
677 if (hwirq < domain->revmap_size)
678 return domain->linear_revmap[hwirq];
679
680 rcu_read_lock();
681 data = radix_tree_lookup(&domain->revmap_tree, hwirq);
682 rcu_read_unlock();
683 return data ? data->irq : 0;
684}
685EXPORT_SYMBOL_GPL(irq_find_mapping);
686
687#ifdef CONFIG_IRQ_DOMAIN_DEBUG
688static int virq_debug_show(struct seq_file *m, void *private)
689{
690 unsigned long flags;
691 struct irq_desc *desc;
692 struct irq_domain *domain;
693 struct radix_tree_iter iter;
694 void *data, **slot;
695 int i;
696
697 seq_printf(m, " %-16s %-6s %-10s %-10s %s\n",
698 "name", "mapped", "linear-max", "direct-max", "devtree-node");
699 mutex_lock(&irq_domain_mutex);
700 list_for_each_entry(domain, &irq_domain_list, link) {
701 struct device_node *of_node;
702 int count = 0;
703 of_node = irq_domain_get_of_node(domain);
704 radix_tree_for_each_slot(slot, &domain->revmap_tree, &iter, 0)
705 count++;
706 seq_printf(m, "%c%-16s %6u %10u %10u %s\n",
707 domain == irq_default_domain ? '*' : ' ', domain->name,
708 domain->revmap_size + count, domain->revmap_size,
709 domain->revmap_direct_max_irq,
710 of_node ? of_node_full_name(of_node) : "");
711 }
712 mutex_unlock(&irq_domain_mutex);
713
714 seq_printf(m, "%-5s %-7s %-15s %-*s %6s %-14s %s\n", "irq", "hwirq",
715 "chip name", (int)(2 * sizeof(void *) + 2), "chip data",
716 "active", "type", "domain");
717
718 for (i = 1; i < nr_irqs; i++) {
719 desc = irq_to_desc(i);
720 if (!desc)
721 continue;
722
723 raw_spin_lock_irqsave(&desc->lock, flags);
724 domain = desc->irq_data.domain;
725
726 if (domain) {
727 struct irq_chip *chip;
728 int hwirq = desc->irq_data.hwirq;
729 bool direct;
730
731 seq_printf(m, "%5d ", i);
732 seq_printf(m, "0x%05x ", hwirq);
733
734 chip = irq_desc_get_chip(desc);
735 seq_printf(m, "%-15s ", (chip && chip->name) ? chip->name : "none");
736
737 data = irq_desc_get_chip_data(desc);
738 seq_printf(m, data ? "0x%p " : " %p ", data);
739
740 seq_printf(m, " %c ", (desc->action && desc->action->handler) ? '*' : ' ');
741 direct = (i == hwirq) && (i < domain->revmap_direct_max_irq);
742 seq_printf(m, "%6s%-8s ",
743 (hwirq < domain->revmap_size) ? "LINEAR" : "RADIX",
744 direct ? "(DIRECT)" : "");
745 seq_printf(m, "%s\n", desc->irq_data.domain->name);
746 }
747
748 raw_spin_unlock_irqrestore(&desc->lock, flags);
749 }
750
751 return 0;
752}
753
754static int virq_debug_open(struct inode *inode, struct file *file)
755{
756 return single_open(file, virq_debug_show, inode->i_private);
757}
758
759static const struct file_operations virq_debug_fops = {
760 .open = virq_debug_open,
761 .read = seq_read,
762 .llseek = seq_lseek,
763 .release = single_release,
764};
765
766static int __init irq_debugfs_init(void)
767{
768 if (debugfs_create_file("irq_domain_mapping", S_IRUGO, NULL,
769 NULL, &virq_debug_fops) == NULL)
770 return -ENOMEM;
771
772 return 0;
773}
774__initcall(irq_debugfs_init);
775#endif
776
777
778
779
780
781
782
783int irq_domain_xlate_onecell(struct irq_domain *d, struct device_node *ctrlr,
784 const u32 *intspec, unsigned int intsize,
785 unsigned long *out_hwirq, unsigned int *out_type)
786{
787 if (WARN_ON(intsize < 1))
788 return -EINVAL;
789 *out_hwirq = intspec[0];
790 *out_type = IRQ_TYPE_NONE;
791 return 0;
792}
793EXPORT_SYMBOL_GPL(irq_domain_xlate_onecell);
794
795
796
797
798
799
800
801
802int irq_domain_xlate_twocell(struct irq_domain *d, struct device_node *ctrlr,
803 const u32 *intspec, unsigned int intsize,
804 irq_hw_number_t *out_hwirq, unsigned int *out_type)
805{
806 if (WARN_ON(intsize < 2))
807 return -EINVAL;
808 *out_hwirq = intspec[0];
809 *out_type = intspec[1] & IRQ_TYPE_SENSE_MASK;
810 return 0;
811}
812EXPORT_SYMBOL_GPL(irq_domain_xlate_twocell);
813
814
815
816
817
818
819
820
821
822
823
824
825int irq_domain_xlate_onetwocell(struct irq_domain *d,
826 struct device_node *ctrlr,
827 const u32 *intspec, unsigned int intsize,
828 unsigned long *out_hwirq, unsigned int *out_type)
829{
830 if (WARN_ON(intsize < 1))
831 return -EINVAL;
832 *out_hwirq = intspec[0];
833 *out_type = (intsize > 1) ? intspec[1] : IRQ_TYPE_NONE;
834 return 0;
835}
836EXPORT_SYMBOL_GPL(irq_domain_xlate_onetwocell);
837
838const struct irq_domain_ops irq_domain_simple_ops = {
839 .xlate = irq_domain_xlate_onetwocell,
840};
841EXPORT_SYMBOL_GPL(irq_domain_simple_ops);
842
843static int irq_domain_alloc_descs(int virq, unsigned int cnt,
844 irq_hw_number_t hwirq, int node)
845{
846 unsigned int hint;
847
848 if (virq >= 0) {
849 virq = irq_alloc_descs(virq, virq, cnt, node);
850 } else {
851 hint = hwirq % nr_irqs;
852 if (hint == 0)
853 hint++;
854 virq = irq_alloc_descs_from(hint, cnt, node);
855 if (virq <= 0 && hint > 1)
856 virq = irq_alloc_descs_from(1, cnt, node);
857 }
858
859 return virq;
860}
861
862#ifdef CONFIG_IRQ_DOMAIN_HIERARCHY
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878struct irq_domain *irq_domain_create_hierarchy(struct irq_domain *parent,
879 unsigned int flags,
880 unsigned int size,
881 struct fwnode_handle *fwnode,
882 const struct irq_domain_ops *ops,
883 void *host_data)
884{
885 struct irq_domain *domain;
886
887 if (size)
888 domain = irq_domain_create_linear(fwnode, size, ops, host_data);
889 else
890 domain = irq_domain_create_tree(fwnode, ops, host_data);
891 if (domain) {
892 domain->parent = parent;
893 domain->flags |= flags;
894 }
895
896 return domain;
897}
898
899static void irq_domain_insert_irq(int virq)
900{
901 struct irq_data *data;
902
903 for (data = irq_get_irq_data(virq); data; data = data->parent_data) {
904 struct irq_domain *domain = data->domain;
905 irq_hw_number_t hwirq = data->hwirq;
906
907 if (hwirq < domain->revmap_size) {
908 domain->linear_revmap[hwirq] = virq;
909 } else {
910 mutex_lock(&revmap_trees_mutex);
911 radix_tree_insert(&domain->revmap_tree, hwirq, data);
912 mutex_unlock(&revmap_trees_mutex);
913 }
914
915
916 if (!domain->name && data->chip)
917 domain->name = data->chip->name;
918 }
919
920 irq_clear_status_flags(virq, IRQ_NOREQUEST);
921}
922
923static void irq_domain_remove_irq(int virq)
924{
925 struct irq_data *data;
926
927 irq_set_status_flags(virq, IRQ_NOREQUEST);
928 irq_set_chip_and_handler(virq, NULL, NULL);
929 synchronize_irq(virq);
930 smp_mb();
931
932 for (data = irq_get_irq_data(virq); data; data = data->parent_data) {
933 struct irq_domain *domain = data->domain;
934 irq_hw_number_t hwirq = data->hwirq;
935
936 if (hwirq < domain->revmap_size) {
937 domain->linear_revmap[hwirq] = 0;
938 } else {
939 mutex_lock(&revmap_trees_mutex);
940 radix_tree_delete(&domain->revmap_tree, hwirq);
941 mutex_unlock(&revmap_trees_mutex);
942 }
943 }
944}
945
946static struct irq_data *irq_domain_insert_irq_data(struct irq_domain *domain,
947 struct irq_data *child)
948{
949 struct irq_data *irq_data;
950
951 irq_data = kzalloc_node(sizeof(*irq_data), GFP_KERNEL,
952 irq_data_get_node(child));
953 if (irq_data) {
954 child->parent_data = irq_data;
955 irq_data->irq = child->irq;
956 irq_data->common = child->common;
957 irq_data->domain = domain;
958 }
959
960 return irq_data;
961}
962
963static void irq_domain_free_irq_data(unsigned int virq, unsigned int nr_irqs)
964{
965 struct irq_data *irq_data, *tmp;
966 int i;
967
968 for (i = 0; i < nr_irqs; i++) {
969 irq_data = irq_get_irq_data(virq + i);
970 tmp = irq_data->parent_data;
971 irq_data->parent_data = NULL;
972 irq_data->domain = NULL;
973
974 while (tmp) {
975 irq_data = tmp;
976 tmp = tmp->parent_data;
977 kfree(irq_data);
978 }
979 }
980}
981
982static int irq_domain_alloc_irq_data(struct irq_domain *domain,
983 unsigned int virq, unsigned int nr_irqs)
984{
985 struct irq_data *irq_data;
986 struct irq_domain *parent;
987 int i;
988
989
990 for (i = 0; i < nr_irqs; i++) {
991 irq_data = irq_get_irq_data(virq + i);
992 irq_data->domain = domain;
993
994 for (parent = domain->parent; parent; parent = parent->parent) {
995 irq_data = irq_domain_insert_irq_data(parent, irq_data);
996 if (!irq_data) {
997 irq_domain_free_irq_data(virq, i + 1);
998 return -ENOMEM;
999 }
1000 }
1001 }
1002
1003 return 0;
1004}
1005
1006
1007
1008
1009
1010
1011struct irq_data *irq_domain_get_irq_data(struct irq_domain *domain,
1012 unsigned int virq)
1013{
1014 struct irq_data *irq_data;
1015
1016 for (irq_data = irq_get_irq_data(virq); irq_data;
1017 irq_data = irq_data->parent_data)
1018 if (irq_data->domain == domain)
1019 return irq_data;
1020
1021 return NULL;
1022}
1023EXPORT_SYMBOL_GPL(irq_domain_get_irq_data);
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033int irq_domain_set_hwirq_and_chip(struct irq_domain *domain, unsigned int virq,
1034 irq_hw_number_t hwirq, struct irq_chip *chip,
1035 void *chip_data)
1036{
1037 struct irq_data *irq_data = irq_domain_get_irq_data(domain, virq);
1038
1039 if (!irq_data)
1040 return -ENOENT;
1041
1042 irq_data->hwirq = hwirq;
1043 irq_data->chip = chip ? chip : &no_irq_chip;
1044 irq_data->chip_data = chip_data;
1045
1046 return 0;
1047}
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060void irq_domain_set_info(struct irq_domain *domain, unsigned int virq,
1061 irq_hw_number_t hwirq, struct irq_chip *chip,
1062 void *chip_data, irq_flow_handler_t handler,
1063 void *handler_data, const char *handler_name)
1064{
1065 irq_domain_set_hwirq_and_chip(domain, virq, hwirq, chip, chip_data);
1066 __irq_set_handler(virq, handler, 0, handler_name);
1067 irq_set_handler_data(virq, handler_data);
1068}
1069EXPORT_SYMBOL(irq_domain_set_info);
1070
1071
1072
1073
1074
1075void irq_domain_reset_irq_data(struct irq_data *irq_data)
1076{
1077 irq_data->hwirq = 0;
1078 irq_data->chip = &no_irq_chip;
1079 irq_data->chip_data = NULL;
1080}
1081
1082
1083
1084
1085
1086
1087
1088void irq_domain_free_irqs_common(struct irq_domain *domain, unsigned int virq,
1089 unsigned int nr_irqs)
1090{
1091 struct irq_data *irq_data;
1092 int i;
1093
1094 for (i = 0; i < nr_irqs; i++) {
1095 irq_data = irq_domain_get_irq_data(domain, virq + i);
1096 if (irq_data)
1097 irq_domain_reset_irq_data(irq_data);
1098 }
1099 irq_domain_free_irqs_parent(domain, virq, nr_irqs);
1100}
1101
1102
1103
1104
1105
1106
1107
1108void irq_domain_free_irqs_top(struct irq_domain *domain, unsigned int virq,
1109 unsigned int nr_irqs)
1110{
1111 int i;
1112
1113 for (i = 0; i < nr_irqs; i++) {
1114 irq_set_handler_data(virq + i, NULL);
1115 irq_set_handler(virq + i, NULL);
1116 }
1117 irq_domain_free_irqs_common(domain, virq, nr_irqs);
1118}
1119
1120static bool irq_domain_is_auto_recursive(struct irq_domain *domain)
1121{
1122 return domain->flags & IRQ_DOMAIN_FLAG_AUTO_RECURSIVE;
1123}
1124
1125static void irq_domain_free_irqs_recursive(struct irq_domain *domain,
1126 unsigned int irq_base,
1127 unsigned int nr_irqs)
1128{
1129 domain->ops->free(domain, irq_base, nr_irqs);
1130 if (irq_domain_is_auto_recursive(domain)) {
1131 BUG_ON(!domain->parent);
1132 irq_domain_free_irqs_recursive(domain->parent, irq_base,
1133 nr_irqs);
1134 }
1135}
1136
1137int irq_domain_alloc_irqs_recursive(struct irq_domain *domain,
1138 unsigned int irq_base,
1139 unsigned int nr_irqs, void *arg)
1140{
1141 int ret = 0;
1142 struct irq_domain *parent = domain->parent;
1143 bool recursive = irq_domain_is_auto_recursive(domain);
1144
1145 BUG_ON(recursive && !parent);
1146 if (recursive)
1147 ret = irq_domain_alloc_irqs_recursive(parent, irq_base,
1148 nr_irqs, arg);
1149 if (ret >= 0)
1150 ret = domain->ops->alloc(domain, irq_base, nr_irqs, arg);
1151 if (ret < 0 && recursive)
1152 irq_domain_free_irqs_recursive(parent, irq_base, nr_irqs);
1153
1154 return ret;
1155}
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178int __irq_domain_alloc_irqs(struct irq_domain *domain, int irq_base,
1179 unsigned int nr_irqs, int node, void *arg,
1180 bool realloc)
1181{
1182 int i, ret, virq;
1183
1184 if (domain == NULL) {
1185 domain = irq_default_domain;
1186 if (WARN(!domain, "domain is NULL; cannot allocate IRQ\n"))
1187 return -EINVAL;
1188 }
1189
1190 if (!domain->ops->alloc) {
1191 pr_debug("domain->ops->alloc() is NULL\n");
1192 return -ENOSYS;
1193 }
1194
1195 if (realloc && irq_base >= 0) {
1196 virq = irq_base;
1197 } else {
1198 virq = irq_domain_alloc_descs(irq_base, nr_irqs, 0, node);
1199 if (virq < 0) {
1200 pr_debug("cannot allocate IRQ(base %d, count %d)\n",
1201 irq_base, nr_irqs);
1202 return virq;
1203 }
1204 }
1205
1206 if (irq_domain_alloc_irq_data(domain, virq, nr_irqs)) {
1207 pr_debug("cannot allocate memory for IRQ%d\n", virq);
1208 ret = -ENOMEM;
1209 goto out_free_desc;
1210 }
1211
1212 mutex_lock(&irq_domain_mutex);
1213 ret = irq_domain_alloc_irqs_recursive(domain, virq, nr_irqs, arg);
1214 if (ret < 0) {
1215 mutex_unlock(&irq_domain_mutex);
1216 goto out_free_irq_data;
1217 }
1218 for (i = 0; i < nr_irqs; i++)
1219 irq_domain_insert_irq(virq + i);
1220 mutex_unlock(&irq_domain_mutex);
1221
1222 return virq;
1223
1224out_free_irq_data:
1225 irq_domain_free_irq_data(virq, nr_irqs);
1226out_free_desc:
1227 irq_free_descs(virq, nr_irqs);
1228 return ret;
1229}
1230
1231
1232
1233
1234
1235
1236void irq_domain_free_irqs(unsigned int virq, unsigned int nr_irqs)
1237{
1238 struct irq_data *data = irq_get_irq_data(virq);
1239 int i;
1240
1241 if (WARN(!data || !data->domain || !data->domain->ops->free,
1242 "NULL pointer, cannot free irq\n"))
1243 return;
1244
1245 mutex_lock(&irq_domain_mutex);
1246 for (i = 0; i < nr_irqs; i++)
1247 irq_domain_remove_irq(virq + i);
1248 irq_domain_free_irqs_recursive(data->domain, virq, nr_irqs);
1249 mutex_unlock(&irq_domain_mutex);
1250
1251 irq_domain_free_irq_data(virq, nr_irqs);
1252 irq_free_descs(virq, nr_irqs);
1253}
1254
1255
1256
1257
1258
1259
1260
1261
1262
1263
1264int irq_domain_alloc_irqs_parent(struct irq_domain *domain,
1265 unsigned int irq_base, unsigned int nr_irqs,
1266 void *arg)
1267{
1268
1269 if (irq_domain_is_auto_recursive(domain))
1270 return 0;
1271
1272 domain = domain->parent;
1273 if (domain)
1274 return irq_domain_alloc_irqs_recursive(domain, irq_base,
1275 nr_irqs, arg);
1276 return -ENOSYS;
1277}
1278
1279
1280
1281
1282
1283
1284
1285
1286
1287void irq_domain_free_irqs_parent(struct irq_domain *domain,
1288 unsigned int irq_base, unsigned int nr_irqs)
1289{
1290
1291 if (!irq_domain_is_auto_recursive(domain) && domain->parent)
1292 irq_domain_free_irqs_recursive(domain->parent, irq_base,
1293 nr_irqs);
1294}
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304void irq_domain_activate_irq(struct irq_data *irq_data)
1305{
1306 if (irq_data && irq_data->domain) {
1307 struct irq_domain *domain = irq_data->domain;
1308
1309 if (irq_data->parent_data)
1310 irq_domain_activate_irq(irq_data->parent_data);
1311 if (domain->ops->activate)
1312 domain->ops->activate(domain, irq_data);
1313 }
1314}
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324void irq_domain_deactivate_irq(struct irq_data *irq_data)
1325{
1326 if (irq_data && irq_data->domain) {
1327 struct irq_domain *domain = irq_data->domain;
1328
1329 if (domain->ops->deactivate)
1330 domain->ops->deactivate(domain, irq_data);
1331 if (irq_data->parent_data)
1332 irq_domain_deactivate_irq(irq_data->parent_data);
1333 }
1334}
1335
1336static void irq_domain_check_hierarchy(struct irq_domain *domain)
1337{
1338
1339 if (domain->ops->alloc)
1340 domain->flags |= IRQ_DOMAIN_FLAG_HIERARCHY;
1341}
1342#else
1343
1344
1345
1346
1347
1348struct irq_data *irq_domain_get_irq_data(struct irq_domain *domain,
1349 unsigned int virq)
1350{
1351 struct irq_data *irq_data = irq_get_irq_data(virq);
1352
1353 return (irq_data && irq_data->domain == domain) ? irq_data : NULL;
1354}
1355EXPORT_SYMBOL_GPL(irq_domain_get_irq_data);
1356
1357
1358
1359
1360
1361
1362
1363
1364
1365
1366
1367
1368void irq_domain_set_info(struct irq_domain *domain, unsigned int virq,
1369 irq_hw_number_t hwirq, struct irq_chip *chip,
1370 void *chip_data, irq_flow_handler_t handler,
1371 void *handler_data, const char *handler_name)
1372{
1373 irq_set_chip_and_handler_name(virq, chip, handler, handler_name);
1374 irq_set_chip_data(virq, chip_data);
1375 irq_set_handler_data(virq, handler_data);
1376}
1377
1378static void irq_domain_check_hierarchy(struct irq_domain *domain)
1379{
1380}
1381#endif
1382