1818e915fSJiaxun Yang // SPDX-License-Identifier: GPL-2.0
2818e915fSJiaxun Yang /*
3818e915fSJiaxun Yang * Copyright (C) 2020, Jiaxun Yang <jiaxun.yang@flygoat.com>
4818e915fSJiaxun Yang * Loongson HyperTransport Interrupt Vector support
5818e915fSJiaxun Yang */
6818e915fSJiaxun Yang
7818e915fSJiaxun Yang #define pr_fmt(fmt) "htvec: " fmt
8818e915fSJiaxun Yang
9818e915fSJiaxun Yang #include <linux/interrupt.h>
10818e915fSJiaxun Yang #include <linux/irq.h>
11818e915fSJiaxun Yang #include <linux/irqchip.h>
12818e915fSJiaxun Yang #include <linux/irqdomain.h>
13818e915fSJiaxun Yang #include <linux/irqchip/chained_irq.h>
14818e915fSJiaxun Yang #include <linux/kernel.h>
15818e915fSJiaxun Yang #include <linux/platform_device.h>
16818e915fSJiaxun Yang #include <linux/of_address.h>
17818e915fSJiaxun Yang #include <linux/of_irq.h>
18*1be356c9SHuacai Chen #include <linux/syscore_ops.h>
19818e915fSJiaxun Yang
20818e915fSJiaxun Yang /* Registers */
21818e915fSJiaxun Yang #define HTVEC_EN_OFF 0x20
22c47e388cSHuacai Chen #define HTVEC_MAX_PARENT_IRQ 8
23818e915fSJiaxun Yang #define VEC_COUNT_PER_REG 32
24818e915fSJiaxun Yang #define VEC_REG_IDX(irq_id) ((irq_id) / VEC_COUNT_PER_REG)
25818e915fSJiaxun Yang #define VEC_REG_BIT(irq_id) ((irq_id) % VEC_COUNT_PER_REG)
26818e915fSJiaxun Yang
27818e915fSJiaxun Yang struct htvec {
28c47e388cSHuacai Chen int num_parents;
29818e915fSJiaxun Yang void __iomem *base;
30818e915fSJiaxun Yang struct irq_domain *htvec_domain;
31818e915fSJiaxun Yang raw_spinlock_t htvec_lock;
32*1be356c9SHuacai Chen u32 saved_vec_en[HTVEC_MAX_PARENT_IRQ];
33818e915fSJiaxun Yang };
34818e915fSJiaxun Yang
3570f7b6c0SHuacai Chen static struct htvec *htvec_priv;
3670f7b6c0SHuacai Chen
htvec_irq_dispatch(struct irq_desc * desc)37818e915fSJiaxun Yang static void htvec_irq_dispatch(struct irq_desc *desc)
38818e915fSJiaxun Yang {
39818e915fSJiaxun Yang int i;
40818e915fSJiaxun Yang u32 pending;
41818e915fSJiaxun Yang bool handled = false;
42818e915fSJiaxun Yang struct irq_chip *chip = irq_desc_get_chip(desc);
43818e915fSJiaxun Yang struct htvec *priv = irq_desc_get_handler_data(desc);
44818e915fSJiaxun Yang
45818e915fSJiaxun Yang chained_irq_enter(chip, desc);
46818e915fSJiaxun Yang
47c47e388cSHuacai Chen for (i = 0; i < priv->num_parents; i++) {
48818e915fSJiaxun Yang pending = readl(priv->base + 4 * i);
49818e915fSJiaxun Yang while (pending) {
50818e915fSJiaxun Yang int bit = __ffs(pending);
51818e915fSJiaxun Yang
52046a6ee2SMarc Zyngier generic_handle_domain_irq(priv->htvec_domain,
53046a6ee2SMarc Zyngier bit + VEC_COUNT_PER_REG * i);
54818e915fSJiaxun Yang pending &= ~BIT(bit);
55818e915fSJiaxun Yang handled = true;
56818e915fSJiaxun Yang }
57818e915fSJiaxun Yang }
58818e915fSJiaxun Yang
59818e915fSJiaxun Yang if (!handled)
60818e915fSJiaxun Yang spurious_interrupt();
61818e915fSJiaxun Yang
62818e915fSJiaxun Yang chained_irq_exit(chip, desc);
63818e915fSJiaxun Yang }
64818e915fSJiaxun Yang
htvec_ack_irq(struct irq_data * d)65818e915fSJiaxun Yang static void htvec_ack_irq(struct irq_data *d)
66818e915fSJiaxun Yang {
67818e915fSJiaxun Yang struct htvec *priv = irq_data_get_irq_chip_data(d);
68818e915fSJiaxun Yang
69818e915fSJiaxun Yang writel(BIT(VEC_REG_BIT(d->hwirq)),
70818e915fSJiaxun Yang priv->base + VEC_REG_IDX(d->hwirq) * 4);
71818e915fSJiaxun Yang }
72818e915fSJiaxun Yang
htvec_mask_irq(struct irq_data * d)73818e915fSJiaxun Yang static void htvec_mask_irq(struct irq_data *d)
74818e915fSJiaxun Yang {
75818e915fSJiaxun Yang u32 reg;
76818e915fSJiaxun Yang void __iomem *addr;
77818e915fSJiaxun Yang struct htvec *priv = irq_data_get_irq_chip_data(d);
78818e915fSJiaxun Yang
79818e915fSJiaxun Yang raw_spin_lock(&priv->htvec_lock);
80818e915fSJiaxun Yang addr = priv->base + HTVEC_EN_OFF;
81818e915fSJiaxun Yang addr += VEC_REG_IDX(d->hwirq) * 4;
82818e915fSJiaxun Yang reg = readl(addr);
83818e915fSJiaxun Yang reg &= ~BIT(VEC_REG_BIT(d->hwirq));
84818e915fSJiaxun Yang writel(reg, addr);
85818e915fSJiaxun Yang raw_spin_unlock(&priv->htvec_lock);
86818e915fSJiaxun Yang }
87818e915fSJiaxun Yang
htvec_unmask_irq(struct irq_data * d)88818e915fSJiaxun Yang static void htvec_unmask_irq(struct irq_data *d)
89818e915fSJiaxun Yang {
90818e915fSJiaxun Yang u32 reg;
91818e915fSJiaxun Yang void __iomem *addr;
92818e915fSJiaxun Yang struct htvec *priv = irq_data_get_irq_chip_data(d);
93818e915fSJiaxun Yang
94818e915fSJiaxun Yang raw_spin_lock(&priv->htvec_lock);
95818e915fSJiaxun Yang addr = priv->base + HTVEC_EN_OFF;
96818e915fSJiaxun Yang addr += VEC_REG_IDX(d->hwirq) * 4;
97818e915fSJiaxun Yang reg = readl(addr);
98818e915fSJiaxun Yang reg |= BIT(VEC_REG_BIT(d->hwirq));
99818e915fSJiaxun Yang writel(reg, addr);
100818e915fSJiaxun Yang raw_spin_unlock(&priv->htvec_lock);
101818e915fSJiaxun Yang }
102818e915fSJiaxun Yang
103818e915fSJiaxun Yang static struct irq_chip htvec_irq_chip = {
104818e915fSJiaxun Yang .name = "LOONGSON_HTVEC",
105818e915fSJiaxun Yang .irq_mask = htvec_mask_irq,
106818e915fSJiaxun Yang .irq_unmask = htvec_unmask_irq,
107818e915fSJiaxun Yang .irq_ack = htvec_ack_irq,
108818e915fSJiaxun Yang };
109818e915fSJiaxun Yang
htvec_domain_alloc(struct irq_domain * domain,unsigned int virq,unsigned int nr_irqs,void * arg)110818e915fSJiaxun Yang static int htvec_domain_alloc(struct irq_domain *domain, unsigned int virq,
111818e915fSJiaxun Yang unsigned int nr_irqs, void *arg)
112818e915fSJiaxun Yang {
113dbec3704STiezhu Yang int ret;
114818e915fSJiaxun Yang unsigned long hwirq;
115818e915fSJiaxun Yang unsigned int type, i;
116818e915fSJiaxun Yang struct htvec *priv = domain->host_data;
117818e915fSJiaxun Yang
118dbec3704STiezhu Yang ret = irq_domain_translate_onecell(domain, arg, &hwirq, &type);
119dbec3704STiezhu Yang if (ret)
120dbec3704STiezhu Yang return ret;
121818e915fSJiaxun Yang
122818e915fSJiaxun Yang for (i = 0; i < nr_irqs; i++) {
123818e915fSJiaxun Yang irq_domain_set_info(domain, virq + i, hwirq + i, &htvec_irq_chip,
124818e915fSJiaxun Yang priv, handle_edge_irq, NULL, NULL);
125818e915fSJiaxun Yang }
126818e915fSJiaxun Yang
127818e915fSJiaxun Yang return 0;
128818e915fSJiaxun Yang }
129818e915fSJiaxun Yang
htvec_domain_free(struct irq_domain * domain,unsigned int virq,unsigned int nr_irqs)130818e915fSJiaxun Yang static void htvec_domain_free(struct irq_domain *domain, unsigned int virq,
131818e915fSJiaxun Yang unsigned int nr_irqs)
132818e915fSJiaxun Yang {
133818e915fSJiaxun Yang int i;
134818e915fSJiaxun Yang
135818e915fSJiaxun Yang for (i = 0; i < nr_irqs; i++) {
136818e915fSJiaxun Yang struct irq_data *d = irq_domain_get_irq_data(domain, virq + i);
137818e915fSJiaxun Yang
138818e915fSJiaxun Yang irq_set_handler(virq + i, NULL);
139818e915fSJiaxun Yang irq_domain_reset_irq_data(d);
140818e915fSJiaxun Yang }
141818e915fSJiaxun Yang }
142818e915fSJiaxun Yang
143818e915fSJiaxun Yang static const struct irq_domain_ops htvec_domain_ops = {
144818e915fSJiaxun Yang .translate = irq_domain_translate_onecell,
145818e915fSJiaxun Yang .alloc = htvec_domain_alloc,
146818e915fSJiaxun Yang .free = htvec_domain_free,
147818e915fSJiaxun Yang };
148818e915fSJiaxun Yang
htvec_reset(struct htvec * priv)149818e915fSJiaxun Yang static void htvec_reset(struct htvec *priv)
150818e915fSJiaxun Yang {
151818e915fSJiaxun Yang u32 idx;
152818e915fSJiaxun Yang
153818e915fSJiaxun Yang /* Clear IRQ cause registers, mask all interrupts */
154c47e388cSHuacai Chen for (idx = 0; idx < priv->num_parents; idx++) {
155818e915fSJiaxun Yang writel_relaxed(0x0, priv->base + HTVEC_EN_OFF + 4 * idx);
1561d1e5630SHuacai Chen writel_relaxed(0xFFFFFFFF, priv->base + 4 * idx);
157818e915fSJiaxun Yang }
158818e915fSJiaxun Yang }
159818e915fSJiaxun Yang
htvec_suspend(void)160*1be356c9SHuacai Chen static int htvec_suspend(void)
161*1be356c9SHuacai Chen {
162*1be356c9SHuacai Chen int i;
163*1be356c9SHuacai Chen
164*1be356c9SHuacai Chen for (i = 0; i < htvec_priv->num_parents; i++)
165*1be356c9SHuacai Chen htvec_priv->saved_vec_en[i] = readl(htvec_priv->base + HTVEC_EN_OFF + 4 * i);
166*1be356c9SHuacai Chen
167*1be356c9SHuacai Chen return 0;
168*1be356c9SHuacai Chen }
169*1be356c9SHuacai Chen
htvec_resume(void)170*1be356c9SHuacai Chen static void htvec_resume(void)
171*1be356c9SHuacai Chen {
172*1be356c9SHuacai Chen int i;
173*1be356c9SHuacai Chen
174*1be356c9SHuacai Chen for (i = 0; i < htvec_priv->num_parents; i++)
175*1be356c9SHuacai Chen writel(htvec_priv->saved_vec_en[i], htvec_priv->base + HTVEC_EN_OFF + 4 * i);
176*1be356c9SHuacai Chen }
177*1be356c9SHuacai Chen
178*1be356c9SHuacai Chen static struct syscore_ops htvec_syscore_ops = {
179*1be356c9SHuacai Chen .suspend = htvec_suspend,
180*1be356c9SHuacai Chen .resume = htvec_resume,
181*1be356c9SHuacai Chen };
182*1be356c9SHuacai Chen
htvec_init(phys_addr_t addr,unsigned long size,int num_parents,int parent_irq[],struct fwnode_handle * domain_handle)18370f7b6c0SHuacai Chen static int htvec_init(phys_addr_t addr, unsigned long size,
18470f7b6c0SHuacai Chen int num_parents, int parent_irq[], struct fwnode_handle *domain_handle)
185818e915fSJiaxun Yang {
18670f7b6c0SHuacai Chen int i;
187818e915fSJiaxun Yang struct htvec *priv;
188818e915fSJiaxun Yang
189818e915fSJiaxun Yang priv = kzalloc(sizeof(*priv), GFP_KERNEL);
190818e915fSJiaxun Yang if (!priv)
191818e915fSJiaxun Yang return -ENOMEM;
192818e915fSJiaxun Yang
19370f7b6c0SHuacai Chen priv->num_parents = num_parents;
19470f7b6c0SHuacai Chen priv->base = ioremap(addr, size);
195818e915fSJiaxun Yang raw_spin_lock_init(&priv->htvec_lock);
19670f7b6c0SHuacai Chen
19770f7b6c0SHuacai Chen /* Setup IRQ domain */
19870f7b6c0SHuacai Chen priv->htvec_domain = irq_domain_create_linear(domain_handle,
19970f7b6c0SHuacai Chen (VEC_COUNT_PER_REG * priv->num_parents),
20070f7b6c0SHuacai Chen &htvec_domain_ops, priv);
20170f7b6c0SHuacai Chen if (!priv->htvec_domain) {
20270f7b6c0SHuacai Chen pr_err("loongson-htvec: cannot add IRQ domain\n");
20370f7b6c0SHuacai Chen goto iounmap_base;
204818e915fSJiaxun Yang }
205818e915fSJiaxun Yang
20670f7b6c0SHuacai Chen htvec_reset(priv);
20770f7b6c0SHuacai Chen
20870f7b6c0SHuacai Chen for (i = 0; i < priv->num_parents; i++) {
20970f7b6c0SHuacai Chen irq_set_chained_handler_and_data(parent_irq[i],
21070f7b6c0SHuacai Chen htvec_irq_dispatch, priv);
21170f7b6c0SHuacai Chen }
21270f7b6c0SHuacai Chen
21370f7b6c0SHuacai Chen htvec_priv = priv;
21470f7b6c0SHuacai Chen
215*1be356c9SHuacai Chen register_syscore_ops(&htvec_syscore_ops);
216*1be356c9SHuacai Chen
21770f7b6c0SHuacai Chen return 0;
21870f7b6c0SHuacai Chen
21970f7b6c0SHuacai Chen iounmap_base:
22070f7b6c0SHuacai Chen iounmap(priv->base);
22170f7b6c0SHuacai Chen kfree(priv);
22270f7b6c0SHuacai Chen
22370f7b6c0SHuacai Chen return -EINVAL;
22470f7b6c0SHuacai Chen }
22570f7b6c0SHuacai Chen
22670f7b6c0SHuacai Chen #ifdef CONFIG_OF
22770f7b6c0SHuacai Chen
htvec_of_init(struct device_node * node,struct device_node * parent)22870f7b6c0SHuacai Chen static int htvec_of_init(struct device_node *node,
22970f7b6c0SHuacai Chen struct device_node *parent)
23070f7b6c0SHuacai Chen {
23170f7b6c0SHuacai Chen int i, err;
23270f7b6c0SHuacai Chen int parent_irq[8];
23370f7b6c0SHuacai Chen int num_parents = 0;
23470f7b6c0SHuacai Chen struct resource res;
23570f7b6c0SHuacai Chen
23670f7b6c0SHuacai Chen if (of_address_to_resource(node, 0, &res))
23770f7b6c0SHuacai Chen return -EINVAL;
23870f7b6c0SHuacai Chen
2391d1e5630SHuacai Chen /* Interrupt may come from any of the 8 interrupt lines */
240818e915fSJiaxun Yang for (i = 0; i < HTVEC_MAX_PARENT_IRQ; i++) {
241818e915fSJiaxun Yang parent_irq[i] = irq_of_parse_and_map(node, i);
242818e915fSJiaxun Yang if (parent_irq[i] <= 0)
243818e915fSJiaxun Yang break;
244818e915fSJiaxun Yang
24570f7b6c0SHuacai Chen num_parents++;
246818e915fSJiaxun Yang }
247818e915fSJiaxun Yang
24870f7b6c0SHuacai Chen err = htvec_init(res.start, resource_size(&res),
24970f7b6c0SHuacai Chen num_parents, parent_irq, of_node_to_fwnode(node));
25070f7b6c0SHuacai Chen if (err < 0)
25170f7b6c0SHuacai Chen return err;
252818e915fSJiaxun Yang
253818e915fSJiaxun Yang return 0;
254818e915fSJiaxun Yang }
255818e915fSJiaxun Yang
256818e915fSJiaxun Yang IRQCHIP_DECLARE(htvec, "loongson,htvec-1.0", htvec_of_init);
25770f7b6c0SHuacai Chen
25870f7b6c0SHuacai Chen #endif
25970f7b6c0SHuacai Chen
26070f7b6c0SHuacai Chen #ifdef CONFIG_ACPI
pch_pic_parse_madt(union acpi_subtable_headers * header,const unsigned long end)26170f7b6c0SHuacai Chen static int __init pch_pic_parse_madt(union acpi_subtable_headers *header,
26270f7b6c0SHuacai Chen const unsigned long end)
26370f7b6c0SHuacai Chen {
26470f7b6c0SHuacai Chen struct acpi_madt_bio_pic *pchpic_entry = (struct acpi_madt_bio_pic *)header;
26570f7b6c0SHuacai Chen
26670f7b6c0SHuacai Chen return pch_pic_acpi_init(htvec_priv->htvec_domain, pchpic_entry);
26770f7b6c0SHuacai Chen }
26870f7b6c0SHuacai Chen
pch_msi_parse_madt(union acpi_subtable_headers * header,const unsigned long end)26970f7b6c0SHuacai Chen static int __init pch_msi_parse_madt(union acpi_subtable_headers *header,
27070f7b6c0SHuacai Chen const unsigned long end)
27170f7b6c0SHuacai Chen {
27270f7b6c0SHuacai Chen struct acpi_madt_msi_pic *pchmsi_entry = (struct acpi_madt_msi_pic *)header;
27370f7b6c0SHuacai Chen
27470f7b6c0SHuacai Chen return pch_msi_acpi_init(htvec_priv->htvec_domain, pchmsi_entry);
27570f7b6c0SHuacai Chen }
27670f7b6c0SHuacai Chen
acpi_cascade_irqdomain_init(void)27770f7b6c0SHuacai Chen static int __init acpi_cascade_irqdomain_init(void)
27870f7b6c0SHuacai Chen {
27970f7b6c0SHuacai Chen int r;
28070f7b6c0SHuacai Chen
28170f7b6c0SHuacai Chen r = acpi_table_parse_madt(ACPI_MADT_TYPE_BIO_PIC, pch_pic_parse_madt, 0);
28270f7b6c0SHuacai Chen if (r < 0)
28370f7b6c0SHuacai Chen return r;
28470f7b6c0SHuacai Chen
28570f7b6c0SHuacai Chen r = acpi_table_parse_madt(ACPI_MADT_TYPE_MSI_PIC, pch_msi_parse_madt, 0);
28670f7b6c0SHuacai Chen if (r < 0)
28770f7b6c0SHuacai Chen return r;
28870f7b6c0SHuacai Chen
28970f7b6c0SHuacai Chen return 0;
29070f7b6c0SHuacai Chen }
29170f7b6c0SHuacai Chen
htvec_acpi_init(struct irq_domain * parent,struct acpi_madt_ht_pic * acpi_htvec)29270f7b6c0SHuacai Chen int __init htvec_acpi_init(struct irq_domain *parent,
29370f7b6c0SHuacai Chen struct acpi_madt_ht_pic *acpi_htvec)
29470f7b6c0SHuacai Chen {
29570f7b6c0SHuacai Chen int i, ret;
29670f7b6c0SHuacai Chen int num_parents, parent_irq[8];
29770f7b6c0SHuacai Chen struct fwnode_handle *domain_handle;
29870f7b6c0SHuacai Chen
29970f7b6c0SHuacai Chen if (!acpi_htvec)
30070f7b6c0SHuacai Chen return -EINVAL;
30170f7b6c0SHuacai Chen
30270f7b6c0SHuacai Chen num_parents = HTVEC_MAX_PARENT_IRQ;
30370f7b6c0SHuacai Chen
30470f7b6c0SHuacai Chen domain_handle = irq_domain_alloc_fwnode(&acpi_htvec->address);
30570f7b6c0SHuacai Chen if (!domain_handle) {
30670f7b6c0SHuacai Chen pr_err("Unable to allocate domain handle\n");
30770f7b6c0SHuacai Chen return -ENOMEM;
30870f7b6c0SHuacai Chen }
30970f7b6c0SHuacai Chen
31070f7b6c0SHuacai Chen /* Interrupt may come from any of the 8 interrupt lines */
31170f7b6c0SHuacai Chen for (i = 0; i < HTVEC_MAX_PARENT_IRQ; i++)
31270f7b6c0SHuacai Chen parent_irq[i] = irq_create_mapping(parent, acpi_htvec->cascade[i]);
31370f7b6c0SHuacai Chen
31470f7b6c0SHuacai Chen ret = htvec_init(acpi_htvec->address, acpi_htvec->size,
31570f7b6c0SHuacai Chen num_parents, parent_irq, domain_handle);
31670f7b6c0SHuacai Chen
31770f7b6c0SHuacai Chen if (ret == 0)
31870f7b6c0SHuacai Chen ret = acpi_cascade_irqdomain_init();
31970f7b6c0SHuacai Chen else
32070f7b6c0SHuacai Chen irq_domain_free_fwnode(domain_handle);
32170f7b6c0SHuacai Chen
32270f7b6c0SHuacai Chen return ret;
32370f7b6c0SHuacai Chen }
32470f7b6c0SHuacai Chen
32570f7b6c0SHuacai Chen #endif
326