Lines Matching +full:int +full:- +full:fwd +full:- +full:mask
1 // SPDX-License-Identifier: GPL-2.0-only
43 unsigned int n_words;
83 static inline unsigned int reg_status(struct bcm7038_l1_chip *intc, in reg_status()
84 unsigned int word) in reg_status()
86 return (0 * intc->n_words + word) * sizeof(u32); in reg_status()
89 static inline unsigned int reg_mask_status(struct bcm7038_l1_chip *intc, in reg_mask_status()
90 unsigned int word) in reg_mask_status()
92 return (1 * intc->n_words + word) * sizeof(u32); in reg_mask_status()
95 static inline unsigned int reg_mask_set(struct bcm7038_l1_chip *intc, in reg_mask_set()
96 unsigned int word) in reg_mask_set()
98 return (2 * intc->n_words + word) * sizeof(u32); in reg_mask_set()
101 static inline unsigned int reg_mask_clr(struct bcm7038_l1_chip *intc, in reg_mask_clr()
102 unsigned int word) in reg_mask_clr()
104 return (3 * intc->n_words + word) * sizeof(u32); in reg_mask_clr()
128 unsigned int idx; in bcm7038_l1_irq_handle()
131 cpu = intc->cpus[cpu_logical_map(smp_processor_id())]; in bcm7038_l1_irq_handle()
133 cpu = intc->cpus[0]; in bcm7038_l1_irq_handle()
138 for (idx = 0; idx < intc->n_words; idx++) { in bcm7038_l1_irq_handle()
139 int base = idx * IRQS_PER_WORD; in bcm7038_l1_irq_handle()
141 int hwirq; in bcm7038_l1_irq_handle()
143 raw_spin_lock_irqsave(&intc->lock, flags); in bcm7038_l1_irq_handle()
144 pending = l1_readl(cpu->map_base + reg_status(intc, idx)) & in bcm7038_l1_irq_handle()
145 ~cpu->mask_cache[idx]; in bcm7038_l1_irq_handle()
146 raw_spin_unlock_irqrestore(&intc->lock, flags); in bcm7038_l1_irq_handle()
149 generic_handle_irq(irq_find_mapping(intc->domain, in bcm7038_l1_irq_handle()
157 static void __bcm7038_l1_unmask(struct irq_data *d, unsigned int cpu_idx) in __bcm7038_l1_unmask()
160 u32 word = d->hwirq / IRQS_PER_WORD; in __bcm7038_l1_unmask()
161 u32 mask = BIT(d->hwirq % IRQS_PER_WORD); in __bcm7038_l1_unmask() local
163 intc->cpus[cpu_idx]->mask_cache[word] &= ~mask; in __bcm7038_l1_unmask()
164 l1_writel(mask, intc->cpus[cpu_idx]->map_base + in __bcm7038_l1_unmask()
168 static void __bcm7038_l1_mask(struct irq_data *d, unsigned int cpu_idx) in __bcm7038_l1_mask()
171 u32 word = d->hwirq / IRQS_PER_WORD; in __bcm7038_l1_mask()
172 u32 mask = BIT(d->hwirq % IRQS_PER_WORD); in __bcm7038_l1_mask() local
174 intc->cpus[cpu_idx]->mask_cache[word] |= mask; in __bcm7038_l1_mask()
175 l1_writel(mask, intc->cpus[cpu_idx]->map_base + in __bcm7038_l1_mask()
184 raw_spin_lock_irqsave(&intc->lock, flags); in bcm7038_l1_unmask()
185 __bcm7038_l1_unmask(d, intc->affinity[d->hwirq]); in bcm7038_l1_unmask()
186 raw_spin_unlock_irqrestore(&intc->lock, flags); in bcm7038_l1_unmask()
194 raw_spin_lock_irqsave(&intc->lock, flags); in bcm7038_l1_mask()
195 __bcm7038_l1_mask(d, intc->affinity[d->hwirq]); in bcm7038_l1_mask()
196 raw_spin_unlock_irqrestore(&intc->lock, flags); in bcm7038_l1_mask()
199 static int bcm7038_l1_set_affinity(struct irq_data *d, in bcm7038_l1_set_affinity()
205 irq_hw_number_t hw = d->hwirq; in bcm7038_l1_set_affinity()
207 u32 mask = BIT(hw % IRQS_PER_WORD); in bcm7038_l1_set_affinity() local
208 unsigned int first_cpu = cpumask_any_and(dest, cpu_online_mask); in bcm7038_l1_set_affinity()
211 raw_spin_lock_irqsave(&intc->lock, flags); in bcm7038_l1_set_affinity()
213 was_disabled = !!(intc->cpus[intc->affinity[hw]]->mask_cache[word] & in bcm7038_l1_set_affinity()
214 mask); in bcm7038_l1_set_affinity()
215 __bcm7038_l1_mask(d, intc->affinity[hw]); in bcm7038_l1_set_affinity()
216 intc->affinity[hw] = first_cpu; in bcm7038_l1_set_affinity()
220 raw_spin_unlock_irqrestore(&intc->lock, flags); in bcm7038_l1_set_affinity()
229 struct cpumask *mask = irq_data_get_affinity_mask(d); in bcm7038_l1_cpu_offline() local
230 int cpu = smp_processor_id(); in bcm7038_l1_cpu_offline()
233 /* This CPU was not on the affinity mask */ in bcm7038_l1_cpu_offline()
234 if (!cpumask_test_cpu(cpu, mask)) in bcm7038_l1_cpu_offline()
237 if (cpumask_weight(mask) > 1) { in bcm7038_l1_cpu_offline()
240 * mask in bcm7038_l1_cpu_offline()
242 cpumask_copy(&new_affinity, mask); in bcm7038_l1_cpu_offline()
253 static int __init bcm7038_l1_init_one(struct device_node *dn, in bcm7038_l1_init_one()
254 unsigned int idx, in bcm7038_l1_init_one()
260 unsigned int i, n_words, parent_irq; in bcm7038_l1_init_one()
261 int ret; in bcm7038_l1_init_one()
264 return -EINVAL; in bcm7038_l1_init_one()
269 return -EINVAL; in bcm7038_l1_init_one()
270 else if (!intc->n_words) in bcm7038_l1_init_one()
271 intc->n_words = n_words; in bcm7038_l1_init_one()
272 else if (intc->n_words != n_words) in bcm7038_l1_init_one()
273 return -EINVAL; in bcm7038_l1_init_one()
275 ret = of_property_read_u32_array(dn , "brcm,int-fwd-mask", in bcm7038_l1_init_one()
276 intc->irq_fwd_mask, n_words); in bcm7038_l1_init_one()
277 if (ret != 0 && ret != -EINVAL) { in bcm7038_l1_init_one()
279 pr_err("invalid brcm,int-fwd-mask property\n"); in bcm7038_l1_init_one()
280 return -EINVAL; in bcm7038_l1_init_one()
283 cpu = intc->cpus[idx] = kzalloc(sizeof(*cpu) + n_words * sizeof(u32), in bcm7038_l1_init_one()
286 return -ENOMEM; in bcm7038_l1_init_one()
288 cpu->map_base = ioremap(res.start, sz); in bcm7038_l1_init_one()
289 if (!cpu->map_base) in bcm7038_l1_init_one()
290 return -ENOMEM; in bcm7038_l1_init_one()
293 l1_writel(~intc->irq_fwd_mask[i], in bcm7038_l1_init_one()
294 cpu->map_base + reg_mask_set(intc, i)); in bcm7038_l1_init_one()
295 l1_writel(intc->irq_fwd_mask[i], in bcm7038_l1_init_one()
296 cpu->map_base + reg_mask_clr(intc, i)); in bcm7038_l1_init_one()
297 cpu->mask_cache[i] = ~intc->irq_fwd_mask[i]; in bcm7038_l1_init_one()
303 return -EINVAL; in bcm7038_l1_init_one()
306 if (of_property_read_bool(dn, "brcm,irq-can-wake")) in bcm7038_l1_init_one()
326 static int bcm7038_l1_suspend(void) in bcm7038_l1_suspend()
329 int boot_cpu, word; in bcm7038_l1_suspend()
340 for (word = 0; word < intc->n_words; word++) { in bcm7038_l1_suspend()
341 val = intc->wake_mask[word] | intc->irq_fwd_mask[word]; in bcm7038_l1_suspend()
343 intc->cpus[boot_cpu]->map_base + reg_mask_set(intc, word)); in bcm7038_l1_suspend()
345 intc->cpus[boot_cpu]->map_base + reg_mask_clr(intc, word)); in bcm7038_l1_suspend()
355 int boot_cpu, word; in bcm7038_l1_resume()
364 for (word = 0; word < intc->n_words; word++) { in bcm7038_l1_resume()
365 l1_writel(intc->cpus[boot_cpu]->mask_cache[word], in bcm7038_l1_resume()
366 intc->cpus[boot_cpu]->map_base + reg_mask_set(intc, word)); in bcm7038_l1_resume()
367 l1_writel(~intc->cpus[boot_cpu]->mask_cache[word], in bcm7038_l1_resume()
368 intc->cpus[boot_cpu]->map_base + reg_mask_clr(intc, word)); in bcm7038_l1_resume()
378 static int bcm7038_l1_set_wake(struct irq_data *d, unsigned int on) in bcm7038_l1_set_wake()
382 u32 word = d->hwirq / IRQS_PER_WORD; in bcm7038_l1_set_wake()
383 u32 mask = BIT(d->hwirq % IRQS_PER_WORD); in bcm7038_l1_set_wake() local
385 raw_spin_lock_irqsave(&intc->lock, flags); in bcm7038_l1_set_wake()
387 intc->wake_mask[word] |= mask; in bcm7038_l1_set_wake()
389 intc->wake_mask[word] &= ~mask; in bcm7038_l1_set_wake()
390 raw_spin_unlock_irqrestore(&intc->lock, flags); in bcm7038_l1_set_wake()
397 .name = "bcm7038-l1",
409 static int bcm7038_l1_map(struct irq_domain *d, unsigned int virq, in bcm7038_l1_map()
412 struct bcm7038_l1_chip *intc = d->host_data; in bcm7038_l1_map()
413 u32 mask = BIT(hw_irq % IRQS_PER_WORD); in bcm7038_l1_map() local
416 if (intc->irq_fwd_mask[word] & mask) in bcm7038_l1_map()
417 return -EPERM; in bcm7038_l1_map()
420 irq_set_chip_data(virq, d->host_data); in bcm7038_l1_map()
430 static int __init bcm7038_l1_of_init(struct device_node *dn, in bcm7038_l1_of_init()
434 int idx, ret; in bcm7038_l1_of_init()
438 return -ENOMEM; in bcm7038_l1_of_init()
440 raw_spin_lock_init(&intc->lock); in bcm7038_l1_of_init()
451 intc->domain = irq_domain_add_linear(dn, IRQS_PER_WORD * intc->n_words, in bcm7038_l1_of_init()
454 if (!intc->domain) { in bcm7038_l1_of_init()
455 ret = -ENOMEM; in bcm7038_l1_of_init()
462 list_add_tail(&intc->list, &bcm7038_l1_intcs_list); in bcm7038_l1_of_init()
470 dn, IRQS_PER_WORD * intc->n_words); in bcm7038_l1_of_init()
476 struct bcm7038_l1_cpu *cpu = intc->cpus[idx]; in bcm7038_l1_of_init()
479 if (cpu->map_base) in bcm7038_l1_of_init()
480 iounmap(cpu->map_base); in bcm7038_l1_of_init()
489 IRQCHIP_DECLARE(bcm7038_l1, "brcm,bcm7038-l1-intc", bcm7038_l1_of_init);