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