Blame view
drivers/irqchip/irq-mtk-sysirq.c
4.33 KB
5fe3bba30 irqchip: mtk-sysi... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 |
/* * Copyright (c) 2014 MediaTek Inc. * Author: Joe.C <yingjoe.chen@mediatek.com> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include <linux/irq.h> |
41a83e06e irqchip: Prepare ... |
16 |
#include <linux/irqchip.h> |
5fe3bba30 irqchip: mtk-sysi... |
17 18 19 20 21 22 23 |
#include <linux/irqdomain.h> #include <linux/of.h> #include <linux/of_irq.h> #include <linux/of_address.h> #include <linux/io.h> #include <linux/slab.h> #include <linux/spinlock.h> |
5fe3bba30 irqchip: mtk-sysi... |
24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 |
struct mtk_sysirq_chip_data { spinlock_t lock; void __iomem *intpol_base; }; static int mtk_sysirq_set_type(struct irq_data *data, unsigned int type) { irq_hw_number_t hwirq = data->hwirq; struct mtk_sysirq_chip_data *chip_data = data->chip_data; u32 offset, reg_index, value; unsigned long flags; int ret; offset = hwirq & 0x1f; reg_index = hwirq >> 5; spin_lock_irqsave(&chip_data->lock, flags); value = readl_relaxed(chip_data->intpol_base + reg_index * 4); if (type == IRQ_TYPE_LEVEL_LOW || type == IRQ_TYPE_EDGE_FALLING) { if (type == IRQ_TYPE_LEVEL_LOW) type = IRQ_TYPE_LEVEL_HIGH; else type = IRQ_TYPE_EDGE_RISING; value |= (1 << offset); } else { value &= ~(1 << offset); } writel(value, chip_data->intpol_base + reg_index * 4); data = data->parent_data; ret = data->chip->irq_set_type(data, type); spin_unlock_irqrestore(&chip_data->lock, flags); return ret; } static struct irq_chip mtk_sysirq_chip = { .name = "MT_SYSIRQ", .irq_mask = irq_chip_mask_parent, .irq_unmask = irq_chip_unmask_parent, .irq_eoi = irq_chip_eoi_parent, .irq_set_type = mtk_sysirq_set_type, .irq_retrigger = irq_chip_retrigger_hierarchy, .irq_set_affinity = irq_chip_set_affinity_parent, }; |
f833f57ff irqchip: Convert ... |
68 69 70 71 |
static int mtk_sysirq_domain_translate(struct irq_domain *d, struct irq_fwspec *fwspec, unsigned long *hwirq, unsigned int *type) |
5fe3bba30 irqchip: mtk-sysi... |
72 |
{ |
f833f57ff irqchip: Convert ... |
73 74 75 |
if (is_of_node(fwspec->fwnode)) { if (fwspec->param_count != 3) return -EINVAL; |
5fe3bba30 irqchip: mtk-sysi... |
76 |
|
f833f57ff irqchip: Convert ... |
77 78 79 80 81 82 83 84 |
/* No PPI should point to this domain */ if (fwspec->param[0] != 0) return -EINVAL; *hwirq = fwspec->param[1]; *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; return 0; } |
5fe3bba30 irqchip: mtk-sysi... |
85 |
|
f833f57ff irqchip: Convert ... |
86 |
return -EINVAL; |
5fe3bba30 irqchip: mtk-sysi... |
87 88 89 90 91 92 93 |
} static int mtk_sysirq_domain_alloc(struct irq_domain *domain, unsigned int virq, unsigned int nr_irqs, void *arg) { int i; irq_hw_number_t hwirq; |
f833f57ff irqchip: Convert ... |
94 95 |
struct irq_fwspec *fwspec = arg; struct irq_fwspec gic_fwspec = *fwspec; |
5fe3bba30 irqchip: mtk-sysi... |
96 |
|
f833f57ff irqchip: Convert ... |
97 |
if (fwspec->param_count != 3) |
5fe3bba30 irqchip: mtk-sysi... |
98 99 100 |
return -EINVAL; /* sysirq doesn't support PPI */ |
f833f57ff irqchip: Convert ... |
101 |
if (fwspec->param[0]) |
5fe3bba30 irqchip: mtk-sysi... |
102 |
return -EINVAL; |
f833f57ff irqchip: Convert ... |
103 |
hwirq = fwspec->param[1]; |
5fe3bba30 irqchip: mtk-sysi... |
104 105 106 107 |
for (i = 0; i < nr_irqs; i++) irq_domain_set_hwirq_and_chip(domain, virq + i, hwirq + i, &mtk_sysirq_chip, domain->host_data); |
f833f57ff irqchip: Convert ... |
108 109 |
gic_fwspec.fwnode = domain->parent->fwnode; return irq_domain_alloc_irqs_parent(domain, virq, nr_irqs, &gic_fwspec); |
5fe3bba30 irqchip: mtk-sysi... |
110 |
} |
960097365 irqchip: Constify... |
111 |
static const struct irq_domain_ops sysirq_domain_ops = { |
f833f57ff irqchip: Convert ... |
112 113 114 |
.translate = mtk_sysirq_domain_translate, .alloc = mtk_sysirq_domain_alloc, .free = irq_domain_free_irqs_common, |
5fe3bba30 irqchip: mtk-sysi... |
115 116 117 118 119 120 121 |
}; static int __init mtk_sysirq_of_init(struct device_node *node, struct device_node *parent) { struct irq_domain *domain, *domain_parent; struct mtk_sysirq_chip_data *chip_data; |
cdb647a77 irqchip: mtk-sysi... |
122 123 |
int ret, size, intpol_num; struct resource res; |
5fe3bba30 irqchip: mtk-sysi... |
124 125 126 127 128 129 130 |
domain_parent = irq_find_host(parent); if (!domain_parent) { pr_err("mtk_sysirq: interrupt-parent not found "); return -EINVAL; } |
cdb647a77 irqchip: mtk-sysi... |
131 132 133 |
ret = of_address_to_resource(node, 0, &res); if (ret) return ret; |
5fe3bba30 irqchip: mtk-sysi... |
134 135 136 |
chip_data = kzalloc(sizeof(*chip_data), GFP_KERNEL); if (!chip_data) return -ENOMEM; |
cdb647a77 irqchip: mtk-sysi... |
137 138 139 140 |
size = resource_size(&res); intpol_num = size * 8; chip_data->intpol_base = ioremap(res.start, size); if (!chip_data->intpol_base) { |
5fe3bba30 irqchip: mtk-sysi... |
141 142 |
pr_err("mtk_sysirq: unable to map sysirq register "); |
e1a96fb86 irqchip: mtk-sysi... |
143 |
ret = -ENXIO; |
5fe3bba30 irqchip: mtk-sysi... |
144 145 |
goto out_free; } |
cdb647a77 irqchip: mtk-sysi... |
146 |
domain = irq_domain_add_hierarchy(domain_parent, 0, intpol_num, node, |
5fe3bba30 irqchip: mtk-sysi... |
147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 |
&sysirq_domain_ops, chip_data); if (!domain) { ret = -ENOMEM; goto out_unmap; } spin_lock_init(&chip_data->lock); return 0; out_unmap: iounmap(chip_data->intpol_base); out_free: kfree(chip_data); return ret; } IRQCHIP_DECLARE(mtk_sysirq, "mediatek,mt6577-sysirq", mtk_sysirq_of_init); |