| .. | .. |
|---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-only |
|---|
| 1 | 2 | /* |
|---|
| 2 | 3 | * 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/>. |
|---|
| 15 | 4 | */ |
|---|
| 16 | 5 | |
|---|
| 17 | 6 | #include <linux/interrupt.h> |
|---|
| .. | .. |
|---|
| 36 | 25 | gic_kvm_info = info; |
|---|
| 37 | 26 | } |
|---|
| 38 | 27 | |
|---|
| 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 | + |
|---|
| 39 | 40 | void gic_enable_quirks(u32 iidr, const struct gic_quirk *quirks, |
|---|
| 40 | 41 | void *data) |
|---|
| 41 | 42 | { |
|---|
| 42 | 43 | for (; quirks->desc; quirks++) { |
|---|
| 44 | + if (quirks->compatible) |
|---|
| 45 | + continue; |
|---|
| 43 | 46 | if (quirks->iidr != (quirks->mask & iidr)) |
|---|
| 44 | 47 | continue; |
|---|
| 45 | 48 | if (quirks->init(data)) |
|---|
| .. | .. |
|---|
| 62 | 65 | * for "irq", depending on "type". |
|---|
| 63 | 66 | */ |
|---|
| 64 | 67 | 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); |
|---|
| 66 | 69 | if (type & IRQ_TYPE_LEVEL_MASK) |
|---|
| 67 | 70 | val &= ~confmask; |
|---|
| 68 | 71 | else if (type & IRQ_TYPE_EDGE_BOTH) |
|---|
| .. | .. |
|---|
| 82 | 85 | * does not allow us to set the configuration or we are in a |
|---|
| 83 | 86 | * non-secure mode, and hence it may not be catastrophic. |
|---|
| 84 | 87 | */ |
|---|
| 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 | + |
|---|
| 93 | 92 | raw_spin_unlock_irqrestore(&irq_controller_lock, flags); |
|---|
| 94 | 93 | |
|---|
| 95 | 94 | if (sync_access) |
|---|
| .. | .. |
|---|
| 131 | 130 | sync_access(); |
|---|
| 132 | 131 | } |
|---|
| 133 | 132 | |
|---|
| 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)) |
|---|
| 135 | 134 | { |
|---|
| 136 | 135 | int i; |
|---|
| 137 | 136 | |
|---|
| 138 | 137 | /* |
|---|
| 139 | 138 | * 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. |
|---|
| 142 | 140 | */ |
|---|
| 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 | + } |
|---|
| 146 | 147 | |
|---|
| 147 | 148 | /* |
|---|
| 148 | 149 | * Set priority on PPI and SGI interrupts |
|---|
| 149 | 150 | */ |
|---|
| 150 | | - for (i = 0; i < 32; i += 4) |
|---|
| 151 | + for (i = 0; i < nr; i += 4) |
|---|
| 151 | 152 | writel_relaxed(GICD_INT_DEF_PRI_X4, |
|---|
| 152 | 153 | base + GIC_DIST_PRI + i * 4 / 4); |
|---|
| 153 | 154 | |
|---|