Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Marvell Armada 370 and Armada XP SoC IRQ handling |
| 3 | * |
| 4 | * Copyright (C) 2012 Marvell |
| 5 | * |
| 6 | * Lior Amsalem <alior@marvell.com> |
| 7 | * Gregory CLEMENT <gregory.clement@free-electrons.com> |
| 8 | * Thomas Petazzoni <thomas.petazzoni@free-electrons.com> |
| 9 | * Ben Dooks <ben.dooks@codethink.co.uk> |
| 10 | * |
| 11 | * This file is licensed under the terms of the GNU General Public |
| 12 | * License version 2. This program is licensed "as is" without any |
| 13 | * warranty of any kind, whether express or implied. |
| 14 | */ |
| 15 | |
| 16 | #include <linux/kernel.h> |
| 17 | #include <linux/module.h> |
| 18 | #include <linux/init.h> |
| 19 | #include <linux/irq.h> |
| 20 | #include <linux/interrupt.h> |
Joel Porquet | 41a83e06 | 2015-07-07 17:11:46 -0400 | [diff] [blame] | 21 | #include <linux/irqchip.h> |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 22 | #include <linux/irqchip/chained_irq.h> |
Thomas Petazzoni | d7df84b | 2014-04-14 15:54:02 +0200 | [diff] [blame] | 23 | #include <linux/cpu.h> |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 24 | #include <linux/io.h> |
| 25 | #include <linux/of_address.h> |
| 26 | #include <linux/of_irq.h> |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 27 | #include <linux/of_pci.h> |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 28 | #include <linux/irqdomain.h> |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 29 | #include <linux/slab.h> |
Thomas Petazzoni | 0f077eb | 2014-11-21 17:00:00 +0100 | [diff] [blame] | 30 | #include <linux/syscore_ops.h> |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 31 | #include <linux/msi.h> |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 32 | #include <asm/mach/arch.h> |
| 33 | #include <asm/exception.h> |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 34 | #include <asm/smp_plat.h> |
Thomas Petazzoni | 9339d43 | 2013-04-09 23:26:15 +0200 | [diff] [blame] | 35 | #include <asm/mach/irq.h> |
| 36 | |
Thomas Petazzoni | 054ea4c | 2017-05-18 10:07:38 +0200 | [diff] [blame^] | 37 | /* |
| 38 | * Overall diagram of the Armada XP interrupt controller: |
| 39 | * |
| 40 | * To CPU 0 To CPU 1 |
| 41 | * |
| 42 | * /\ /\ |
| 43 | * || || |
| 44 | * +---------------+ +---------------+ |
| 45 | * | | | | |
| 46 | * | per-CPU | | per-CPU | |
| 47 | * | mask/unmask | | mask/unmask | |
| 48 | * | CPU0 | | CPU1 | |
| 49 | * | | | | |
| 50 | * +---------------+ +---------------+ |
| 51 | * /\ /\ |
| 52 | * || || |
| 53 | * \\_______________________// |
| 54 | * || |
| 55 | * +-------------------+ |
| 56 | * | | |
| 57 | * | Global interrupt | |
| 58 | * | mask/unmask | |
| 59 | * | | |
| 60 | * +-------------------+ |
| 61 | * /\ |
| 62 | * || |
| 63 | * interrupt from |
| 64 | * device |
| 65 | * |
| 66 | * The "global interrupt mask/unmask" is modified using the |
| 67 | * ARMADA_370_XP_INT_SET_ENABLE_OFFS and |
| 68 | * ARMADA_370_XP_INT_CLEAR_ENABLE_OFFS registers, which are relative |
| 69 | * to "main_int_base". |
| 70 | * |
| 71 | * The "per-CPU mask/unmask" is modified using the |
| 72 | * ARMADA_370_XP_INT_SET_MASK_OFFS and |
| 73 | * ARMADA_370_XP_INT_CLEAR_MASK_OFFS registers, which are relative to |
| 74 | * "per_cpu_int_base". This base address points to a special address, |
| 75 | * which automatically accesses the registers of the current CPU. |
| 76 | * |
| 77 | * The per-CPU mask/unmask can also be adjusted using the global |
| 78 | * per-interrupt ARMADA_370_XP_INT_SOURCE_CTL register, which we use |
| 79 | * to configure interrupt affinity. |
| 80 | * |
| 81 | * Due to this model, all interrupts need to be mask/unmasked at two |
| 82 | * different levels: at the global level and at the per-CPU level. |
| 83 | * |
| 84 | * This driver takes the following approach to deal with this: |
| 85 | * |
| 86 | * - For global interrupts: |
| 87 | * |
| 88 | * At ->map() time, a global interrupt is unmasked at the per-CPU |
| 89 | * mask/unmask level. It is therefore unmasked at this level for |
| 90 | * the current CPU, running the ->map() code. This allows to have |
| 91 | * the interrupt unmasked at this level in non-SMP |
| 92 | * configurations. In SMP configurations, the ->set_affinity() |
| 93 | * callback is called, which using the |
| 94 | * ARMADA_370_XP_INT_SOURCE_CTL() readjusts the per-CPU mask/unmask |
| 95 | * for the interrupt. |
| 96 | * |
| 97 | * The ->mask() and ->unmask() operations only mask/unmask the |
| 98 | * interrupt at the "global" level. |
| 99 | * |
| 100 | * So, a global interrupt is enabled at the per-CPU level as soon |
| 101 | * as it is mapped. At run time, the masking/unmasking takes place |
| 102 | * at the global level. |
| 103 | * |
| 104 | * - For per-CPU interrupts |
| 105 | * |
| 106 | * At ->map() time, a per-CPU interrupt is unmasked at the global |
| 107 | * mask/unmask level. |
| 108 | * |
| 109 | * The ->mask() and ->unmask() operations mask/unmask the interrupt |
| 110 | * at the per-CPU level. |
| 111 | * |
| 112 | * So, a per-CPU interrupt is enabled at the global level as soon |
| 113 | * as it is mapped. At run time, the masking/unmasking takes place |
| 114 | * at the per-CPU level. |
| 115 | */ |
| 116 | |
Thomas Petazzoni | 9a234c9 | 2017-05-18 10:07:37 +0200 | [diff] [blame] | 117 | /* Registers relative to main_int_base */ |
Ben Dooks | f3e16cc | 2012-06-04 18:50:12 +0200 | [diff] [blame] | 118 | #define ARMADA_370_XP_INT_CONTROL (0x00) |
Thomas Petazzoni | 9a234c9 | 2017-05-18 10:07:37 +0200 | [diff] [blame] | 119 | #define ARMADA_370_XP_SW_TRIG_INT_OFFS (0x04) |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 120 | #define ARMADA_370_XP_INT_SET_ENABLE_OFFS (0x30) |
| 121 | #define ARMADA_370_XP_INT_CLEAR_ENABLE_OFFS (0x34) |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 122 | #define ARMADA_370_XP_INT_SOURCE_CTL(irq) (0x100 + irq*4) |
Thomas Gleixner | 8cc3cfc | 2014-03-04 20:43:41 +0000 | [diff] [blame] | 123 | #define ARMADA_370_XP_INT_SOURCE_CPU_MASK 0xF |
Grzegorz Jaszczyk | 758e836 | 2014-09-25 13:17:19 +0200 | [diff] [blame] | 124 | #define ARMADA_370_XP_INT_IRQ_FIQ_MASK(cpuid) ((BIT(0) | BIT(8)) << cpuid) |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 125 | |
Thomas Petazzoni | 9a234c9 | 2017-05-18 10:07:37 +0200 | [diff] [blame] | 126 | /* Registers relative to per_cpu_int_base */ |
| 127 | #define ARMADA_370_XP_IN_DRBEL_CAUSE_OFFS (0x08) |
| 128 | #define ARMADA_370_XP_IN_DRBEL_MSK_OFFS (0x0c) |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 129 | #define ARMADA_375_PPI_CAUSE (0x10) |
Thomas Petazzoni | 9a234c9 | 2017-05-18 10:07:37 +0200 | [diff] [blame] | 130 | #define ARMADA_370_XP_CPU_INTACK_OFFS (0x44) |
| 131 | #define ARMADA_370_XP_INT_SET_MASK_OFFS (0x48) |
| 132 | #define ARMADA_370_XP_INT_CLEAR_MASK_OFFS (0x4C) |
| 133 | #define ARMADA_370_XP_INT_FABRIC_MASK_OFFS (0x54) |
| 134 | #define ARMADA_370_XP_INT_CAUSE_PERF(cpu) (1 << cpu) |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 135 | |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 136 | #define ARMADA_370_XP_MAX_PER_CPU_IRQS (28) |
| 137 | |
Thomas Petazzoni | 5ec6901 | 2013-04-09 23:26:17 +0200 | [diff] [blame] | 138 | #define IPI_DOORBELL_START (0) |
| 139 | #define IPI_DOORBELL_END (8) |
| 140 | #define IPI_DOORBELL_MASK 0xFF |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 141 | #define PCI_MSI_DOORBELL_START (16) |
| 142 | #define PCI_MSI_DOORBELL_NR (16) |
| 143 | #define PCI_MSI_DOORBELL_END (32) |
| 144 | #define PCI_MSI_DOORBELL_MASK 0xFFFF0000 |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 145 | |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 146 | static void __iomem *per_cpu_int_base; |
| 147 | static void __iomem *main_int_base; |
| 148 | static struct irq_domain *armada_370_xp_mpic_domain; |
Thomas Petazzoni | 0f077eb | 2014-11-21 17:00:00 +0100 | [diff] [blame] | 149 | static u32 doorbell_mask_reg; |
Maxime Ripard | 5724be8 | 2015-03-03 11:27:23 +0100 | [diff] [blame] | 150 | static int parent_irq; |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 151 | #ifdef CONFIG_PCI_MSI |
| 152 | static struct irq_domain *armada_370_xp_msi_domain; |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 153 | static struct irq_domain *armada_370_xp_msi_inner_domain; |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 154 | static DECLARE_BITMAP(msi_used, PCI_MSI_DOORBELL_NR); |
| 155 | static DEFINE_MUTEX(msi_used_lock); |
| 156 | static phys_addr_t msi_doorbell_addr; |
| 157 | #endif |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 158 | |
Ezequiel Garcia | 2c299de | 2015-03-03 11:43:15 +0100 | [diff] [blame] | 159 | static inline bool is_percpu_irq(irq_hw_number_t irq) |
| 160 | { |
Maxime Ripard | 080481f9 | 2015-09-25 18:09:34 +0200 | [diff] [blame] | 161 | if (irq <= ARMADA_370_XP_MAX_PER_CPU_IRQS) |
Ezequiel Garcia | 2c299de | 2015-03-03 11:43:15 +0100 | [diff] [blame] | 162 | return true; |
Maxime Ripard | 080481f9 | 2015-09-25 18:09:34 +0200 | [diff] [blame] | 163 | |
| 164 | return false; |
Ezequiel Garcia | 2c299de | 2015-03-03 11:43:15 +0100 | [diff] [blame] | 165 | } |
| 166 | |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 167 | /* |
| 168 | * In SMP mode: |
| 169 | * For shared global interrupts, mask/unmask global enable bit |
Marek Belisko | 097ef18 | 2013-03-15 23:34:04 +0100 | [diff] [blame] | 170 | * For CPU interrupts, mask/unmask the calling CPU's bit |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 171 | */ |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 172 | static void armada_370_xp_irq_mask(struct irq_data *d) |
| 173 | { |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 174 | irq_hw_number_t hwirq = irqd_to_hwirq(d); |
| 175 | |
Ezequiel Garcia | 2c299de | 2015-03-03 11:43:15 +0100 | [diff] [blame] | 176 | if (!is_percpu_irq(hwirq)) |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 177 | writel(hwirq, main_int_base + |
| 178 | ARMADA_370_XP_INT_CLEAR_ENABLE_OFFS); |
| 179 | else |
| 180 | writel(hwirq, per_cpu_int_base + |
| 181 | ARMADA_370_XP_INT_SET_MASK_OFFS); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 182 | } |
| 183 | |
| 184 | static void armada_370_xp_irq_unmask(struct irq_data *d) |
| 185 | { |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 186 | irq_hw_number_t hwirq = irqd_to_hwirq(d); |
| 187 | |
Ezequiel Garcia | 2c299de | 2015-03-03 11:43:15 +0100 | [diff] [blame] | 188 | if (!is_percpu_irq(hwirq)) |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 189 | writel(hwirq, main_int_base + |
| 190 | ARMADA_370_XP_INT_SET_ENABLE_OFFS); |
| 191 | else |
| 192 | writel(hwirq, per_cpu_int_base + |
| 193 | ARMADA_370_XP_INT_CLEAR_MASK_OFFS); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 194 | } |
| 195 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 196 | #ifdef CONFIG_PCI_MSI |
| 197 | |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 198 | static struct irq_chip armada_370_xp_msi_irq_chip = { |
Thomas Petazzoni | f692a17 | 2016-02-10 15:46:59 +0100 | [diff] [blame] | 199 | .name = "MPIC MSI", |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 200 | .irq_mask = pci_msi_mask_irq, |
| 201 | .irq_unmask = pci_msi_unmask_irq, |
| 202 | }; |
| 203 | |
| 204 | static struct msi_domain_info armada_370_xp_msi_domain_info = { |
Thomas Petazzoni | a71b941 | 2016-02-10 15:47:00 +0100 | [diff] [blame] | 205 | .flags = (MSI_FLAG_USE_DEF_DOM_OPS | MSI_FLAG_USE_DEF_CHIP_OPS | |
| 206 | MSI_FLAG_MULTI_PCI_MSI), |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 207 | .chip = &armada_370_xp_msi_irq_chip, |
| 208 | }; |
| 209 | |
| 210 | static void armada_370_xp_compose_msi_msg(struct irq_data *data, struct msi_msg *msg) |
| 211 | { |
| 212 | msg->address_lo = lower_32_bits(msi_doorbell_addr); |
| 213 | msg->address_hi = upper_32_bits(msi_doorbell_addr); |
| 214 | msg->data = 0xf00 | (data->hwirq + PCI_MSI_DOORBELL_START); |
| 215 | } |
| 216 | |
| 217 | static int armada_370_xp_msi_set_affinity(struct irq_data *irq_data, |
| 218 | const struct cpumask *mask, bool force) |
| 219 | { |
| 220 | return -EINVAL; |
| 221 | } |
| 222 | |
| 223 | static struct irq_chip armada_370_xp_msi_bottom_irq_chip = { |
Thomas Petazzoni | f692a17 | 2016-02-10 15:46:59 +0100 | [diff] [blame] | 224 | .name = "MPIC MSI", |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 225 | .irq_compose_msi_msg = armada_370_xp_compose_msi_msg, |
| 226 | .irq_set_affinity = armada_370_xp_msi_set_affinity, |
| 227 | }; |
| 228 | |
| 229 | static int armada_370_xp_msi_alloc(struct irq_domain *domain, unsigned int virq, |
| 230 | unsigned int nr_irqs, void *args) |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 231 | { |
Thomas Petazzoni | a71b941 | 2016-02-10 15:47:00 +0100 | [diff] [blame] | 232 | int hwirq, i; |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 233 | |
| 234 | mutex_lock(&msi_used_lock); |
Thomas Petazzoni | a71b941 | 2016-02-10 15:47:00 +0100 | [diff] [blame] | 235 | |
| 236 | hwirq = bitmap_find_next_zero_area(msi_used, PCI_MSI_DOORBELL_NR, |
| 237 | 0, nr_irqs, 0); |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 238 | if (hwirq >= PCI_MSI_DOORBELL_NR) { |
| 239 | mutex_unlock(&msi_used_lock); |
| 240 | return -ENOSPC; |
| 241 | } |
| 242 | |
Thomas Petazzoni | a71b941 | 2016-02-10 15:47:00 +0100 | [diff] [blame] | 243 | bitmap_set(msi_used, hwirq, nr_irqs); |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 244 | mutex_unlock(&msi_used_lock); |
| 245 | |
Thomas Petazzoni | a71b941 | 2016-02-10 15:47:00 +0100 | [diff] [blame] | 246 | for (i = 0; i < nr_irqs; i++) { |
| 247 | irq_domain_set_info(domain, virq + i, hwirq + i, |
| 248 | &armada_370_xp_msi_bottom_irq_chip, |
| 249 | domain->host_data, handle_simple_irq, |
| 250 | NULL, NULL); |
| 251 | } |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 252 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 253 | return hwirq; |
| 254 | } |
| 255 | |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 256 | static void armada_370_xp_msi_free(struct irq_domain *domain, |
| 257 | unsigned int virq, unsigned int nr_irqs) |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 258 | { |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 259 | struct irq_data *d = irq_domain_get_irq_data(domain, virq); |
| 260 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 261 | mutex_lock(&msi_used_lock); |
Thomas Petazzoni | a71b941 | 2016-02-10 15:47:00 +0100 | [diff] [blame] | 262 | bitmap_clear(msi_used, d->hwirq, nr_irqs); |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 263 | mutex_unlock(&msi_used_lock); |
| 264 | } |
| 265 | |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 266 | static const struct irq_domain_ops armada_370_xp_msi_domain_ops = { |
| 267 | .alloc = armada_370_xp_msi_alloc, |
| 268 | .free = armada_370_xp_msi_free, |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 269 | }; |
| 270 | |
| 271 | static int armada_370_xp_msi_init(struct device_node *node, |
| 272 | phys_addr_t main_int_phys_base) |
| 273 | { |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 274 | u32 reg; |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 275 | |
| 276 | msi_doorbell_addr = main_int_phys_base + |
| 277 | ARMADA_370_XP_SW_TRIG_INT_OFFS; |
| 278 | |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 279 | armada_370_xp_msi_inner_domain = |
| 280 | irq_domain_add_linear(NULL, PCI_MSI_DOORBELL_NR, |
| 281 | &armada_370_xp_msi_domain_ops, NULL); |
| 282 | if (!armada_370_xp_msi_inner_domain) |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 283 | return -ENOMEM; |
| 284 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 285 | armada_370_xp_msi_domain = |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 286 | pci_msi_create_irq_domain(of_node_to_fwnode(node), |
| 287 | &armada_370_xp_msi_domain_info, |
| 288 | armada_370_xp_msi_inner_domain); |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 289 | if (!armada_370_xp_msi_domain) { |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 290 | irq_domain_remove(armada_370_xp_msi_inner_domain); |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 291 | return -ENOMEM; |
| 292 | } |
| 293 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 294 | reg = readl(per_cpu_int_base + ARMADA_370_XP_IN_DRBEL_MSK_OFFS) |
| 295 | | PCI_MSI_DOORBELL_MASK; |
| 296 | |
| 297 | writel(reg, per_cpu_int_base + |
| 298 | ARMADA_370_XP_IN_DRBEL_MSK_OFFS); |
| 299 | |
| 300 | /* Unmask IPI interrupt */ |
| 301 | writel(1, per_cpu_int_base + ARMADA_370_XP_INT_CLEAR_MASK_OFFS); |
| 302 | |
| 303 | return 0; |
| 304 | } |
| 305 | #else |
| 306 | static inline int armada_370_xp_msi_init(struct device_node *node, |
| 307 | phys_addr_t main_int_phys_base) |
| 308 | { |
| 309 | return 0; |
| 310 | } |
| 311 | #endif |
| 312 | |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 313 | #ifdef CONFIG_SMP |
Arnaud Ebalard | 19e61d4 | 2014-01-20 22:52:05 +0100 | [diff] [blame] | 314 | static DEFINE_RAW_SPINLOCK(irq_controller_lock); |
| 315 | |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 316 | static int armada_xp_set_affinity(struct irq_data *d, |
| 317 | const struct cpumask *mask_val, bool force) |
| 318 | { |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 319 | irq_hw_number_t hwirq = irqd_to_hwirq(d); |
Thomas Gleixner | 8cc3cfc | 2014-03-04 20:43:41 +0000 | [diff] [blame] | 320 | unsigned long reg, mask; |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 321 | int cpu; |
| 322 | |
Thomas Gleixner | 8cc3cfc | 2014-03-04 20:43:41 +0000 | [diff] [blame] | 323 | /* Select a single core from the affinity mask which is online */ |
| 324 | cpu = cpumask_any_and(mask_val, cpu_online_mask); |
| 325 | mask = 1UL << cpu_logical_map(cpu); |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 326 | |
| 327 | raw_spin_lock(&irq_controller_lock); |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 328 | reg = readl(main_int_base + ARMADA_370_XP_INT_SOURCE_CTL(hwirq)); |
Thomas Gleixner | 8cc3cfc | 2014-03-04 20:43:41 +0000 | [diff] [blame] | 329 | reg = (reg & (~ARMADA_370_XP_INT_SOURCE_CPU_MASK)) | mask; |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 330 | writel(reg, main_int_base + ARMADA_370_XP_INT_SOURCE_CTL(hwirq)); |
Gregory CLEMENT | 3202bf0 | 2012-12-05 21:43:23 +0100 | [diff] [blame] | 331 | raw_spin_unlock(&irq_controller_lock); |
| 332 | |
Thomas Petazzoni | 1dacf19 | 2014-10-24 13:59:16 +0200 | [diff] [blame] | 333 | return IRQ_SET_MASK_OK; |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 334 | } |
| 335 | #endif |
| 336 | |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 337 | static struct irq_chip armada_370_xp_irq_chip = { |
Thomas Petazzoni | f692a17 | 2016-02-10 15:46:59 +0100 | [diff] [blame] | 338 | .name = "MPIC", |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 339 | .irq_mask = armada_370_xp_irq_mask, |
| 340 | .irq_mask_ack = armada_370_xp_irq_mask, |
| 341 | .irq_unmask = armada_370_xp_irq_unmask, |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 342 | #ifdef CONFIG_SMP |
| 343 | .irq_set_affinity = armada_xp_set_affinity, |
| 344 | #endif |
Gregory CLEMENT | 0d8e1d8 | 2015-03-30 16:04:37 +0200 | [diff] [blame] | 345 | .flags = IRQCHIP_SKIP_SET_WAKE | IRQCHIP_MASK_ON_SUSPEND, |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 346 | }; |
| 347 | |
| 348 | static int armada_370_xp_mpic_irq_map(struct irq_domain *h, |
| 349 | unsigned int virq, irq_hw_number_t hw) |
| 350 | { |
| 351 | armada_370_xp_irq_mask(irq_get_irq_data(virq)); |
Ezequiel Garcia | 2c299de | 2015-03-03 11:43:15 +0100 | [diff] [blame] | 352 | if (!is_percpu_irq(hw)) |
Gregory CLEMENT | 600468d | 2013-04-05 14:32:52 +0200 | [diff] [blame] | 353 | writel(hw, per_cpu_int_base + |
| 354 | ARMADA_370_XP_INT_CLEAR_MASK_OFFS); |
| 355 | else |
| 356 | writel(hw, main_int_base + ARMADA_370_XP_INT_SET_ENABLE_OFFS); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 357 | irq_set_status_flags(virq, IRQ_LEVEL); |
Gregory CLEMENT | 3a6f08a | 2013-01-25 18:32:41 +0100 | [diff] [blame] | 358 | |
Ezequiel Garcia | 2c299de | 2015-03-03 11:43:15 +0100 | [diff] [blame] | 359 | if (is_percpu_irq(hw)) { |
Gregory CLEMENT | 3a6f08a | 2013-01-25 18:32:41 +0100 | [diff] [blame] | 360 | irq_set_percpu_devid(virq); |
| 361 | irq_set_chip_and_handler(virq, &armada_370_xp_irq_chip, |
| 362 | handle_percpu_devid_irq); |
| 363 | |
| 364 | } else { |
| 365 | irq_set_chip_and_handler(virq, &armada_370_xp_irq_chip, |
| 366 | handle_level_irq); |
| 367 | } |
Rob Herring | d17cab4 | 2015-08-29 18:01:22 -0500 | [diff] [blame] | 368 | irq_set_probe(virq); |
Thomas Petazzoni | 353d6d6 | 2015-10-21 15:48:15 +0200 | [diff] [blame] | 369 | irq_clear_status_flags(virq, IRQ_NOAUTOEN); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 370 | |
| 371 | return 0; |
| 372 | } |
| 373 | |
Thomas Petazzoni | d7df84b | 2014-04-14 15:54:02 +0200 | [diff] [blame] | 374 | static void armada_xp_mpic_smp_cpu_init(void) |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 375 | { |
Thomas Petazzoni | b73842b | 2014-05-30 22:18:18 +0200 | [diff] [blame] | 376 | u32 control; |
| 377 | int nr_irqs, i; |
| 378 | |
| 379 | control = readl(main_int_base + ARMADA_370_XP_INT_CONTROL); |
| 380 | nr_irqs = (control >> 2) & 0x3ff; |
| 381 | |
| 382 | for (i = 0; i < nr_irqs; i++) |
| 383 | writel(i, per_cpu_int_base + ARMADA_370_XP_INT_SET_MASK_OFFS); |
| 384 | |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 385 | /* Clear pending IPIs */ |
| 386 | writel(0, per_cpu_int_base + ARMADA_370_XP_IN_DRBEL_CAUSE_OFFS); |
| 387 | |
| 388 | /* Enable first 8 IPIs */ |
Thomas Petazzoni | 5ec6901 | 2013-04-09 23:26:17 +0200 | [diff] [blame] | 389 | writel(IPI_DOORBELL_MASK, per_cpu_int_base + |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 390 | ARMADA_370_XP_IN_DRBEL_MSK_OFFS); |
| 391 | |
| 392 | /* Unmask IPI interrupt */ |
| 393 | writel(0, per_cpu_int_base + ARMADA_370_XP_INT_CLEAR_MASK_OFFS); |
| 394 | } |
Thomas Petazzoni | d7df84b | 2014-04-14 15:54:02 +0200 | [diff] [blame] | 395 | |
Maxime Ripard | 28da06d | 2015-03-03 11:43:16 +0100 | [diff] [blame] | 396 | static void armada_xp_mpic_perf_init(void) |
| 397 | { |
| 398 | unsigned long cpuid = cpu_logical_map(smp_processor_id()); |
| 399 | |
| 400 | /* Enable Performance Counter Overflow interrupts */ |
| 401 | writel(ARMADA_370_XP_INT_CAUSE_PERF(cpuid), |
| 402 | per_cpu_int_base + ARMADA_370_XP_INT_FABRIC_MASK_OFFS); |
| 403 | } |
| 404 | |
Ezequiel Garcia | 933a24b | 2015-03-03 11:43:14 +0100 | [diff] [blame] | 405 | #ifdef CONFIG_SMP |
| 406 | static void armada_mpic_send_doorbell(const struct cpumask *mask, |
| 407 | unsigned int irq) |
| 408 | { |
| 409 | int cpu; |
| 410 | unsigned long map = 0; |
| 411 | |
| 412 | /* Convert our logical CPU mask into a physical one. */ |
| 413 | for_each_cpu(cpu, mask) |
| 414 | map |= 1 << cpu_logical_map(cpu); |
| 415 | |
| 416 | /* |
| 417 | * Ensure that stores to Normal memory are visible to the |
| 418 | * other CPUs before issuing the IPI. |
| 419 | */ |
| 420 | dsb(); |
| 421 | |
| 422 | /* submit softirq */ |
| 423 | writel((map << 8) | irq, main_int_base + |
| 424 | ARMADA_370_XP_SW_TRIG_INT_OFFS); |
| 425 | } |
| 426 | |
Richard Cochran | cb5ff2d | 2016-07-13 17:16:07 +0000 | [diff] [blame] | 427 | static int armada_xp_mpic_starting_cpu(unsigned int cpu) |
Thomas Petazzoni | d7df84b | 2014-04-14 15:54:02 +0200 | [diff] [blame] | 428 | { |
Richard Cochran | cb5ff2d | 2016-07-13 17:16:07 +0000 | [diff] [blame] | 429 | armada_xp_mpic_perf_init(); |
| 430 | armada_xp_mpic_smp_cpu_init(); |
| 431 | return 0; |
Thomas Petazzoni | d7df84b | 2014-04-14 15:54:02 +0200 | [diff] [blame] | 432 | } |
| 433 | |
Richard Cochran | cb5ff2d | 2016-07-13 17:16:07 +0000 | [diff] [blame] | 434 | static int mpic_cascaded_starting_cpu(unsigned int cpu) |
Maxime Ripard | 5724be8 | 2015-03-03 11:27:23 +0100 | [diff] [blame] | 435 | { |
Richard Cochran | cb5ff2d | 2016-07-13 17:16:07 +0000 | [diff] [blame] | 436 | armada_xp_mpic_perf_init(); |
| 437 | enable_percpu_irq(parent_irq, IRQ_TYPE_NONE); |
| 438 | return 0; |
Maxime Ripard | 5724be8 | 2015-03-03 11:27:23 +0100 | [diff] [blame] | 439 | } |
Arnd Bergmann | c76c15e | 2016-07-18 18:03:21 +0200 | [diff] [blame] | 440 | #endif |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 441 | |
Krzysztof Kozlowski | 9600973 | 2015-04-27 21:54:24 +0900 | [diff] [blame] | 442 | static const struct irq_domain_ops armada_370_xp_mpic_irq_ops = { |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 443 | .map = armada_370_xp_mpic_irq_map, |
| 444 | .xlate = irq_domain_xlate_onecell, |
| 445 | }; |
| 446 | |
Ezequiel Garcia | 9b8cf77 | 2014-02-10 17:00:01 -0300 | [diff] [blame] | 447 | #ifdef CONFIG_PCI_MSI |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 448 | static void armada_370_xp_handle_msi_irq(struct pt_regs *regs, bool is_chained) |
Ezequiel Garcia | 9b8cf77 | 2014-02-10 17:00:01 -0300 | [diff] [blame] | 449 | { |
| 450 | u32 msimask, msinr; |
| 451 | |
| 452 | msimask = readl_relaxed(per_cpu_int_base + |
| 453 | ARMADA_370_XP_IN_DRBEL_CAUSE_OFFS) |
| 454 | & PCI_MSI_DOORBELL_MASK; |
| 455 | |
| 456 | writel(~msimask, per_cpu_int_base + |
| 457 | ARMADA_370_XP_IN_DRBEL_CAUSE_OFFS); |
| 458 | |
| 459 | for (msinr = PCI_MSI_DOORBELL_START; |
| 460 | msinr < PCI_MSI_DOORBELL_END; msinr++) { |
| 461 | int irq; |
| 462 | |
| 463 | if (!(msimask & BIT(msinr))) |
| 464 | continue; |
| 465 | |
Marc Zyngier | e89c6a0 | 2014-08-26 11:03:21 +0100 | [diff] [blame] | 466 | if (is_chained) { |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 467 | irq = irq_find_mapping(armada_370_xp_msi_inner_domain, |
Thomas Petazzoni | 0636bab | 2016-02-10 15:46:58 +0100 | [diff] [blame] | 468 | msinr - PCI_MSI_DOORBELL_START); |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 469 | generic_handle_irq(irq); |
Marc Zyngier | e89c6a0 | 2014-08-26 11:03:21 +0100 | [diff] [blame] | 470 | } else { |
Thomas Petazzoni | 0636bab | 2016-02-10 15:46:58 +0100 | [diff] [blame] | 471 | irq = msinr - PCI_MSI_DOORBELL_START; |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 472 | handle_domain_irq(armada_370_xp_msi_inner_domain, |
Marc Zyngier | e89c6a0 | 2014-08-26 11:03:21 +0100 | [diff] [blame] | 473 | irq, regs); |
| 474 | } |
Ezequiel Garcia | 9b8cf77 | 2014-02-10 17:00:01 -0300 | [diff] [blame] | 475 | } |
| 476 | } |
| 477 | #else |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 478 | static void armada_370_xp_handle_msi_irq(struct pt_regs *r, bool b) {} |
Ezequiel Garcia | 9b8cf77 | 2014-02-10 17:00:01 -0300 | [diff] [blame] | 479 | #endif |
| 480 | |
Thomas Gleixner | bd0b9ac | 2015-09-14 10:42:37 +0200 | [diff] [blame] | 481 | static void armada_370_xp_mpic_handle_cascade_irq(struct irq_desc *desc) |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 482 | { |
Jiang Liu | 5b29264 | 2015-06-04 12:13:20 +0800 | [diff] [blame] | 483 | struct irq_chip *chip = irq_desc_get_chip(desc); |
Grzegorz Jaszczyk | 758e836 | 2014-09-25 13:17:19 +0200 | [diff] [blame] | 484 | unsigned long irqmap, irqn, irqsrc, cpuid; |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 485 | unsigned int cascade_irq; |
| 486 | |
| 487 | chained_irq_enter(chip, desc); |
| 488 | |
| 489 | irqmap = readl_relaxed(per_cpu_int_base + ARMADA_375_PPI_CAUSE); |
Grzegorz Jaszczyk | 758e836 | 2014-09-25 13:17:19 +0200 | [diff] [blame] | 490 | cpuid = cpu_logical_map(smp_processor_id()); |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 491 | |
| 492 | for_each_set_bit(irqn, &irqmap, BITS_PER_LONG) { |
Grzegorz Jaszczyk | 758e836 | 2014-09-25 13:17:19 +0200 | [diff] [blame] | 493 | irqsrc = readl_relaxed(main_int_base + |
| 494 | ARMADA_370_XP_INT_SOURCE_CTL(irqn)); |
| 495 | |
| 496 | /* Check if the interrupt is not masked on current CPU. |
| 497 | * Test IRQ (0-1) and FIQ (8-9) mask bits. |
| 498 | */ |
| 499 | if (!(irqsrc & ARMADA_370_XP_INT_IRQ_FIQ_MASK(cpuid))) |
| 500 | continue; |
| 501 | |
| 502 | if (irqn == 1) { |
| 503 | armada_370_xp_handle_msi_irq(NULL, true); |
| 504 | continue; |
| 505 | } |
| 506 | |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 507 | cascade_irq = irq_find_mapping(armada_370_xp_mpic_domain, irqn); |
| 508 | generic_handle_irq(cascade_irq); |
| 509 | } |
| 510 | |
| 511 | chained_irq_exit(chip, desc); |
| 512 | } |
| 513 | |
Stephen Boyd | 8783dd3 | 2014-03-04 16:40:30 -0800 | [diff] [blame] | 514 | static void __exception_irq_entry |
Thomas Petazzoni | 9339d43 | 2013-04-09 23:26:15 +0200 | [diff] [blame] | 515 | armada_370_xp_handle_irq(struct pt_regs *regs) |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 516 | { |
| 517 | u32 irqstat, irqnr; |
| 518 | |
| 519 | do { |
| 520 | irqstat = readl_relaxed(per_cpu_int_base + |
| 521 | ARMADA_370_XP_CPU_INTACK_OFFS); |
| 522 | irqnr = irqstat & 0x3FF; |
| 523 | |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 524 | if (irqnr > 1022) |
| 525 | break; |
| 526 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 527 | if (irqnr > 1) { |
Marc Zyngier | e89c6a0 | 2014-08-26 11:03:21 +0100 | [diff] [blame] | 528 | handle_domain_irq(armada_370_xp_mpic_domain, |
| 529 | irqnr, regs); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 530 | continue; |
| 531 | } |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 532 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 533 | /* MSI handling */ |
Ezequiel Garcia | 9b8cf77 | 2014-02-10 17:00:01 -0300 | [diff] [blame] | 534 | if (irqnr == 1) |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 535 | armada_370_xp_handle_msi_irq(regs, false); |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 536 | |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 537 | #ifdef CONFIG_SMP |
| 538 | /* IPI Handling */ |
| 539 | if (irqnr == 0) { |
| 540 | u32 ipimask, ipinr; |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 541 | |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 542 | ipimask = readl_relaxed(per_cpu_int_base + |
| 543 | ARMADA_370_XP_IN_DRBEL_CAUSE_OFFS) |
Thomas Petazzoni | 5ec6901 | 2013-04-09 23:26:17 +0200 | [diff] [blame] | 544 | & IPI_DOORBELL_MASK; |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 545 | |
Lior Amsalem | a6f089e | 2013-11-25 17:26:44 +0100 | [diff] [blame] | 546 | writel(~ipimask, per_cpu_int_base + |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 547 | ARMADA_370_XP_IN_DRBEL_CAUSE_OFFS); |
| 548 | |
| 549 | /* Handle all pending doorbells */ |
Thomas Petazzoni | 5ec6901 | 2013-04-09 23:26:17 +0200 | [diff] [blame] | 550 | for (ipinr = IPI_DOORBELL_START; |
| 551 | ipinr < IPI_DOORBELL_END; ipinr++) { |
Gregory CLEMENT | 344e873 | 2012-08-02 11:19:12 +0300 | [diff] [blame] | 552 | if (ipimask & (0x1 << ipinr)) |
| 553 | handle_IPI(ipinr, regs); |
| 554 | } |
| 555 | continue; |
| 556 | } |
| 557 | #endif |
| 558 | |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 559 | } while (1); |
| 560 | } |
| 561 | |
Thomas Petazzoni | 0f077eb | 2014-11-21 17:00:00 +0100 | [diff] [blame] | 562 | static int armada_370_xp_mpic_suspend(void) |
| 563 | { |
| 564 | doorbell_mask_reg = readl(per_cpu_int_base + |
| 565 | ARMADA_370_XP_IN_DRBEL_MSK_OFFS); |
| 566 | return 0; |
| 567 | } |
| 568 | |
| 569 | static void armada_370_xp_mpic_resume(void) |
| 570 | { |
| 571 | int nirqs; |
| 572 | irq_hw_number_t irq; |
| 573 | |
| 574 | /* Re-enable interrupts */ |
| 575 | nirqs = (readl(main_int_base + ARMADA_370_XP_INT_CONTROL) >> 2) & 0x3ff; |
| 576 | for (irq = 0; irq < nirqs; irq++) { |
| 577 | struct irq_data *data; |
| 578 | int virq; |
| 579 | |
| 580 | virq = irq_linear_revmap(armada_370_xp_mpic_domain, irq); |
| 581 | if (virq == 0) |
| 582 | continue; |
| 583 | |
Maxime Ripard | 080481f9 | 2015-09-25 18:09:34 +0200 | [diff] [blame] | 584 | if (!is_percpu_irq(irq)) |
Thomas Petazzoni | 0f077eb | 2014-11-21 17:00:00 +0100 | [diff] [blame] | 585 | writel(irq, per_cpu_int_base + |
| 586 | ARMADA_370_XP_INT_CLEAR_MASK_OFFS); |
| 587 | else |
| 588 | writel(irq, main_int_base + |
| 589 | ARMADA_370_XP_INT_SET_ENABLE_OFFS); |
| 590 | |
| 591 | data = irq_get_irq_data(virq); |
| 592 | if (!irqd_irq_disabled(data)) |
| 593 | armada_370_xp_irq_unmask(data); |
| 594 | } |
| 595 | |
| 596 | /* Reconfigure doorbells for IPIs and MSIs */ |
| 597 | writel(doorbell_mask_reg, |
| 598 | per_cpu_int_base + ARMADA_370_XP_IN_DRBEL_MSK_OFFS); |
| 599 | if (doorbell_mask_reg & IPI_DOORBELL_MASK) |
| 600 | writel(0, per_cpu_int_base + ARMADA_370_XP_INT_CLEAR_MASK_OFFS); |
| 601 | if (doorbell_mask_reg & PCI_MSI_DOORBELL_MASK) |
| 602 | writel(1, per_cpu_int_base + ARMADA_370_XP_INT_CLEAR_MASK_OFFS); |
| 603 | } |
| 604 | |
Ben Dooks | 6c88090 | 2016-06-08 18:55:33 +0100 | [diff] [blame] | 605 | static struct syscore_ops armada_370_xp_mpic_syscore_ops = { |
Thomas Petazzoni | 0f077eb | 2014-11-21 17:00:00 +0100 | [diff] [blame] | 606 | .suspend = armada_370_xp_mpic_suspend, |
| 607 | .resume = armada_370_xp_mpic_resume, |
| 608 | }; |
| 609 | |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 610 | static int __init armada_370_xp_mpic_of_init(struct device_node *node, |
| 611 | struct device_node *parent) |
| 612 | { |
Thomas Petazzoni | 627dfcc | 2013-08-09 22:27:10 +0200 | [diff] [blame] | 613 | struct resource main_int_res, per_cpu_int_res; |
Maxime Ripard | 5724be8 | 2015-03-03 11:27:23 +0100 | [diff] [blame] | 614 | int nr_irqs, i; |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 615 | u32 control; |
| 616 | |
Thomas Petazzoni | 627dfcc | 2013-08-09 22:27:10 +0200 | [diff] [blame] | 617 | BUG_ON(of_address_to_resource(node, 0, &main_int_res)); |
| 618 | BUG_ON(of_address_to_resource(node, 1, &per_cpu_int_res)); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 619 | |
Thomas Petazzoni | 627dfcc | 2013-08-09 22:27:10 +0200 | [diff] [blame] | 620 | BUG_ON(!request_mem_region(main_int_res.start, |
| 621 | resource_size(&main_int_res), |
| 622 | node->full_name)); |
| 623 | BUG_ON(!request_mem_region(per_cpu_int_res.start, |
| 624 | resource_size(&per_cpu_int_res), |
| 625 | node->full_name)); |
| 626 | |
| 627 | main_int_base = ioremap(main_int_res.start, |
| 628 | resource_size(&main_int_res)); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 629 | BUG_ON(!main_int_base); |
Thomas Petazzoni | 627dfcc | 2013-08-09 22:27:10 +0200 | [diff] [blame] | 630 | |
| 631 | per_cpu_int_base = ioremap(per_cpu_int_res.start, |
| 632 | resource_size(&per_cpu_int_res)); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 633 | BUG_ON(!per_cpu_int_base); |
Gregory CLEMENT | d792b1e | 2012-09-26 18:02:48 +0200 | [diff] [blame] | 634 | |
| 635 | control = readl(main_int_base + ARMADA_370_XP_INT_CONTROL); |
Thomas Petazzoni | b73842b | 2014-05-30 22:18:18 +0200 | [diff] [blame] | 636 | nr_irqs = (control >> 2) & 0x3ff; |
| 637 | |
| 638 | for (i = 0; i < nr_irqs; i++) |
| 639 | writel(i, main_int_base + ARMADA_370_XP_INT_CLEAR_ENABLE_OFFS); |
Gregory CLEMENT | d792b1e | 2012-09-26 18:02:48 +0200 | [diff] [blame] | 640 | |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 641 | armada_370_xp_mpic_domain = |
Thomas Petazzoni | b73842b | 2014-05-30 22:18:18 +0200 | [diff] [blame] | 642 | irq_domain_add_linear(node, nr_irqs, |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 643 | &armada_370_xp_mpic_irq_ops, NULL); |
Thomas Petazzoni | 627dfcc | 2013-08-09 22:27:10 +0200 | [diff] [blame] | 644 | BUG_ON(!armada_370_xp_mpic_domain); |
Thomas Petazzoni | fcc392d | 2016-02-10 15:46:57 +0100 | [diff] [blame] | 645 | armada_370_xp_mpic_domain->bus_token = DOMAIN_BUS_WIRED; |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 646 | |
Ezequiel Garcia | 933a24b | 2015-03-03 11:43:14 +0100 | [diff] [blame] | 647 | /* Setup for the boot CPU */ |
Maxime Ripard | 28da06d | 2015-03-03 11:43:16 +0100 | [diff] [blame] | 648 | armada_xp_mpic_perf_init(); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 649 | armada_xp_mpic_smp_cpu_init(); |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 650 | |
Thomas Petazzoni | 31f614e | 2013-08-09 22:27:11 +0200 | [diff] [blame] | 651 | armada_370_xp_msi_init(node, main_int_res.start); |
| 652 | |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 653 | parent_irq = irq_of_parse_and_map(node, 0); |
| 654 | if (parent_irq <= 0) { |
| 655 | irq_set_default_host(armada_370_xp_mpic_domain); |
| 656 | set_handle_irq(armada_370_xp_handle_irq); |
Thomas Petazzoni | ef37d33 | 2014-04-14 15:54:01 +0200 | [diff] [blame] | 657 | #ifdef CONFIG_SMP |
| 658 | set_smp_cross_call(armada_mpic_send_doorbell); |
Richard Cochran | cb5ff2d | 2016-07-13 17:16:07 +0000 | [diff] [blame] | 659 | cpuhp_setup_state_nocalls(CPUHP_AP_IRQ_ARMADA_XP_STARTING, |
Thomas Gleixner | 73c1b41 | 2016-12-21 20:19:54 +0100 | [diff] [blame] | 660 | "irqchip/armada/ipi:starting", |
Richard Cochran | cb5ff2d | 2016-07-13 17:16:07 +0000 | [diff] [blame] | 661 | armada_xp_mpic_starting_cpu, NULL); |
Thomas Petazzoni | ef37d33 | 2014-04-14 15:54:01 +0200 | [diff] [blame] | 662 | #endif |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 663 | } else { |
Maxime Ripard | 5724be8 | 2015-03-03 11:27:23 +0100 | [diff] [blame] | 664 | #ifdef CONFIG_SMP |
Thomas Gleixner | 008b69e | 2016-12-21 20:19:57 +0100 | [diff] [blame] | 665 | cpuhp_setup_state_nocalls(CPUHP_AP_IRQ_ARMADA_XP_STARTING, |
Thomas Gleixner | 73c1b41 | 2016-12-21 20:19:54 +0100 | [diff] [blame] | 666 | "irqchip/armada/cascade:starting", |
Richard Cochran | cb5ff2d | 2016-07-13 17:16:07 +0000 | [diff] [blame] | 667 | mpic_cascaded_starting_cpu, NULL); |
Maxime Ripard | 5724be8 | 2015-03-03 11:27:23 +0100 | [diff] [blame] | 668 | #endif |
Ezequiel Garcia | bc69b8a | 2014-02-10 17:00:02 -0300 | [diff] [blame] | 669 | irq_set_chained_handler(parent_irq, |
| 670 | armada_370_xp_mpic_handle_cascade_irq); |
| 671 | } |
Thomas Petazzoni | b313ada | 2013-04-09 23:26:16 +0200 | [diff] [blame] | 672 | |
Thomas Petazzoni | 0f077eb | 2014-11-21 17:00:00 +0100 | [diff] [blame] | 673 | register_syscore_ops(&armada_370_xp_mpic_syscore_ops); |
| 674 | |
Thomas Petazzoni | 9ae6f74 | 2012-06-13 19:01:28 +0200 | [diff] [blame] | 675 | return 0; |
| 676 | } |
| 677 | |
Thomas Petazzoni | 9339d43 | 2013-04-09 23:26:15 +0200 | [diff] [blame] | 678 | IRQCHIP_DECLARE(armada_370_xp_mpic, "marvell,mpic", armada_370_xp_mpic_of_init); |