forked from ~ljy/RK356X_SDK_RELEASE

hc
2023-12-09 95099d4622f8cb224d94e314c7a8e0df60b13f87
kernel/drivers/irqchip/irq-gic-common.c
....@@ -1,17 +1,6 @@
1
+// SPDX-License-Identifier: GPL-2.0-only
12 /*
23 * Copyright (C) 2002 ARM Limited, All Rights Reserved.
3
- *
4
- * This program is free software; you can redistribute it and/or modify
5
- * it under the terms of the GNU General Public License version 2 as
6
- * published by the Free Software Foundation.
7
- *
8
- * This program is distributed in the hope that it will be useful,
9
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
10
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11
- * GNU General Public License for more details.
12
- *
13
- * You should have received a copy of the GNU General Public License
14
- * along with this program. If not, see <http://www.gnu.org/licenses/>.
154 */
165
176 #include <linux/interrupt.h>
....@@ -36,10 +25,24 @@
3625 gic_kvm_info = info;
3726 }
3827
28
+void gic_enable_of_quirks(const struct device_node *np,
29
+ const struct gic_quirk *quirks, void *data)
30
+{
31
+ for (; quirks->desc; quirks++) {
32
+ if (!of_device_is_compatible(np, quirks->compatible))
33
+ continue;
34
+ if (quirks->init(data))
35
+ pr_info("GIC: enabling workaround for %s\n",
36
+ quirks->desc);
37
+ }
38
+}
39
+
3940 void gic_enable_quirks(u32 iidr, const struct gic_quirk *quirks,
4041 void *data)
4142 {
4243 for (; quirks->desc; quirks++) {
44
+ if (quirks->compatible)
45
+ continue;
4346 if (quirks->iidr != (quirks->mask & iidr))
4447 continue;
4548 if (quirks->init(data))
....@@ -62,7 +65,7 @@
6265 * for "irq", depending on "type".
6366 */
6467 raw_spin_lock_irqsave(&irq_controller_lock, flags);
65
- val = oldval = readl_relaxed(base + GIC_DIST_CONFIG + confoff);
68
+ val = oldval = readl_relaxed(base + confoff);
6669 if (type & IRQ_TYPE_LEVEL_MASK)
6770 val &= ~confmask;
6871 else if (type & IRQ_TYPE_EDGE_BOTH)
....@@ -82,14 +85,10 @@
8285 * does not allow us to set the configuration or we are in a
8386 * non-secure mode, and hence it may not be catastrophic.
8487 */
85
- writel_relaxed(val, base + GIC_DIST_CONFIG + confoff);
86
- if (readl_relaxed(base + GIC_DIST_CONFIG + confoff) != val) {
87
- if (WARN_ON(irq >= 32))
88
- ret = -EINVAL;
89
- else
90
- pr_warn("GIC: PPI%d is secure or misconfigured\n",
91
- irq - 16);
92
- }
88
+ writel_relaxed(val, base + confoff);
89
+ if (readl_relaxed(base + confoff) != val)
90
+ ret = -EINVAL;
91
+
9392 raw_spin_unlock_irqrestore(&irq_controller_lock, flags);
9493
9594 if (sync_access)
....@@ -131,23 +130,25 @@
131130 sync_access();
132131 }
133132
134
-void gic_cpu_config(void __iomem *base, void (*sync_access)(void))
133
+void gic_cpu_config(void __iomem *base, int nr, void (*sync_access)(void))
135134 {
136135 int i;
137136
138137 /*
139138 * Deal with the banked PPI and SGI interrupts - disable all
140
- * PPI interrupts, ensure all SGI interrupts are enabled.
141
- * Make sure everything is deactivated.
139
+ * private interrupts. Make sure everything is deactivated.
142140 */
143
- writel_relaxed(GICD_INT_EN_CLR_X32, base + GIC_DIST_ACTIVE_CLEAR);
144
- writel_relaxed(GICD_INT_EN_CLR_PPI, base + GIC_DIST_ENABLE_CLEAR);
145
- writel_relaxed(GICD_INT_EN_SET_SGI, base + GIC_DIST_ENABLE_SET);
141
+ for (i = 0; i < nr; i += 32) {
142
+ writel_relaxed(GICD_INT_EN_CLR_X32,
143
+ base + GIC_DIST_ACTIVE_CLEAR + i / 8);
144
+ writel_relaxed(GICD_INT_EN_CLR_X32,
145
+ base + GIC_DIST_ENABLE_CLEAR + i / 8);
146
+ }
146147
147148 /*
148149 * Set priority on PPI and SGI interrupts
149150 */
150
- for (i = 0; i < 32; i += 4)
151
+ for (i = 0; i < nr; i += 4)
151152 writel_relaxed(GICD_INT_DEF_PRI_X4,
152153 base + GIC_DIST_PRI + i * 4 / 4);
153154