Lines Matching +full:cpu +full:- +full:pcie
1 // SPDX-License-Identifier: GPL-2.0
14 #include "pcie-iproc.h"
73 * @pcie: pointer to iProc PCIe data
94 struct iproc_pcie *pcie; member
132 struct iproc_pcie *pcie = msi->pcie; in iproc_msi_read_reg() local
134 return readl_relaxed(pcie->base + msi->reg_offsets[eq][reg]); in iproc_msi_read_reg()
141 struct iproc_pcie *pcie = msi->pcie; in iproc_msi_write_reg() local
143 writel_relaxed(val, pcie->base + msi->reg_offsets[eq][reg]); in iproc_msi_write_reg()
148 return (hwirq % msi->nr_irqs); in hwirq_to_group()
154 if (msi->nr_msi_region > 1) in iproc_msi_addr_offset()
162 if (msi->nr_eq_region > 1) in iproc_msi_eq_offset()
169 .name = "iProc-MSI",
179 * In iProc PCIe core, each MSI group is serviced by a GIC interrupt and a
183 * number of CPU cores also varies. To support MSI IRQ affinity, we
185 * from one GIC interrupt to another to steer to the target CPU.
188 * - the number of MSI groups is M
189 * - the number of CPU cores is N
190 * - M is always a multiple of N
197 return (hwirq % msi->nr_cpus); in hwirq_to_cpu()
203 return (hwirq - hwirq_to_cpu(msi, hwirq)); in hwirq_to_canonical_hwirq()
214 curr_cpu = hwirq_to_cpu(msi, data->hwirq); in iproc_msi_irq_set_affinity()
218 /* steer MSI to the target CPU */ in iproc_msi_irq_set_affinity()
219 data->hwirq = hwirq_to_canonical_hwirq(msi, data->hwirq) + target_cpu; in iproc_msi_irq_set_affinity()
234 addr = msi->msi_addr + iproc_msi_addr_offset(msi, data->hwirq); in iproc_msi_irq_compose_msi_msg()
235 msg->address_lo = lower_32_bits(addr); in iproc_msi_irq_compose_msi_msg()
236 msg->address_hi = upper_32_bits(addr); in iproc_msi_irq_compose_msi_msg()
237 msg->data = data->hwirq << 5; in iproc_msi_irq_compose_msi_msg()
250 struct iproc_msi *msi = domain->host_data; in iproc_msi_irq_domain_alloc()
253 if (msi->nr_cpus > 1 && nr_irqs > 1) in iproc_msi_irq_domain_alloc()
254 return -EINVAL; in iproc_msi_irq_domain_alloc()
256 mutex_lock(&msi->bitmap_lock); in iproc_msi_irq_domain_alloc()
262 hwirq = bitmap_find_free_region(msi->bitmap, msi->nr_msi_vecs, in iproc_msi_irq_domain_alloc()
263 order_base_2(msi->nr_cpus * nr_irqs)); in iproc_msi_irq_domain_alloc()
265 mutex_unlock(&msi->bitmap_lock); in iproc_msi_irq_domain_alloc()
268 return -ENOSPC; in iproc_msi_irq_domain_alloc()
273 domain->host_data, handle_simple_irq, in iproc_msi_irq_domain_alloc()
287 mutex_lock(&msi->bitmap_lock); in iproc_msi_irq_domain_free()
289 hwirq = hwirq_to_canonical_hwirq(msi, data->hwirq); in iproc_msi_irq_domain_free()
290 bitmap_release_region(msi->bitmap, hwirq, in iproc_msi_irq_domain_free()
291 order_base_2(msi->nr_cpus * nr_irqs)); in iproc_msi_irq_domain_free()
293 mutex_unlock(&msi->bitmap_lock); in iproc_msi_irq_domain_free()
310 msg = (u32 __iomem *)(msi->eq_cpu + offs); in decode_msi_hwirq()
334 msi = grp->msi; in iproc_msi_handler()
335 eq = grp->eq; in iproc_msi_handler()
358 (EQ_LEN - (head - tail)) : (tail - head); in iproc_msi_handler()
363 while (nr_events--) { in iproc_msi_handler()
365 virq = irq_find_mapping(msi->inner_domain, hwirq); in iproc_msi_handler()
393 for (i = 0; i < msi->nr_eq_region; i++) { in iproc_msi_enable()
394 dma_addr_t addr = msi->eq_dma + (i * EQ_MEM_REGION_SIZE); in iproc_msi_enable()
403 for (i = 0; i < msi->nr_msi_region; i++) { in iproc_msi_enable()
404 phys_addr_t addr = msi->msi_addr + (i * MSI_MEM_REGION_SIZE); in iproc_msi_enable()
412 for (eq = 0; eq < msi->nr_irqs; eq++) { in iproc_msi_enable()
422 if (msi->has_inten_reg) { in iproc_msi_enable()
434 for (eq = 0; eq < msi->nr_irqs; eq++) { in iproc_msi_disable()
435 if (msi->has_inten_reg) { in iproc_msi_disable()
451 msi->inner_domain = irq_domain_add_linear(NULL, msi->nr_msi_vecs, in iproc_msi_alloc_domains()
453 if (!msi->inner_domain) in iproc_msi_alloc_domains()
454 return -ENOMEM; in iproc_msi_alloc_domains()
456 msi->msi_domain = pci_msi_create_irq_domain(of_node_to_fwnode(node), in iproc_msi_alloc_domains()
458 msi->inner_domain); in iproc_msi_alloc_domains()
459 if (!msi->msi_domain) { in iproc_msi_alloc_domains()
460 irq_domain_remove(msi->inner_domain); in iproc_msi_alloc_domains()
461 return -ENOMEM; in iproc_msi_alloc_domains()
469 if (msi->msi_domain) in iproc_msi_free_domains()
470 irq_domain_remove(msi->msi_domain); in iproc_msi_free_domains()
472 if (msi->inner_domain) in iproc_msi_free_domains()
473 irq_domain_remove(msi->inner_domain); in iproc_msi_free_domains()
476 static void iproc_msi_irq_free(struct iproc_msi *msi, unsigned int cpu) in iproc_msi_irq_free() argument
480 for (i = cpu; i < msi->nr_irqs; i += msi->nr_cpus) { in iproc_msi_irq_free()
481 irq_set_chained_handler_and_data(msi->grps[i].gic_irq, in iproc_msi_irq_free()
486 static int iproc_msi_irq_setup(struct iproc_msi *msi, unsigned int cpu) in iproc_msi_irq_setup() argument
490 struct iproc_pcie *pcie = msi->pcie; in iproc_msi_irq_setup() local
492 for (i = cpu; i < msi->nr_irqs; i += msi->nr_cpus) { in iproc_msi_irq_setup()
493 irq_set_chained_handler_and_data(msi->grps[i].gic_irq, in iproc_msi_irq_setup()
495 &msi->grps[i]); in iproc_msi_irq_setup()
496 /* Dedicate GIC interrupt to each CPU core */ in iproc_msi_irq_setup()
499 cpumask_set_cpu(cpu, mask); in iproc_msi_irq_setup()
500 ret = irq_set_affinity(msi->grps[i].gic_irq, mask); in iproc_msi_irq_setup()
502 dev_err(pcie->dev, in iproc_msi_irq_setup()
504 msi->grps[i].gic_irq); in iproc_msi_irq_setup()
507 dev_err(pcie->dev, "failed to alloc CPU mask\n"); in iproc_msi_irq_setup()
508 ret = -EINVAL; in iproc_msi_irq_setup()
513 iproc_msi_irq_free(msi, cpu); in iproc_msi_irq_setup()
521 int iproc_msi_init(struct iproc_pcie *pcie, struct device_node *node) in iproc_msi_init() argument
525 unsigned int cpu; in iproc_msi_init() local
527 if (!of_device_is_compatible(node, "brcm,iproc-msi")) in iproc_msi_init()
528 return -ENODEV; in iproc_msi_init()
530 if (!of_find_property(node, "msi-controller", NULL)) in iproc_msi_init()
531 return -ENODEV; in iproc_msi_init()
533 if (pcie->msi) in iproc_msi_init()
534 return -EBUSY; in iproc_msi_init()
536 msi = devm_kzalloc(pcie->dev, sizeof(*msi), GFP_KERNEL); in iproc_msi_init()
538 return -ENOMEM; in iproc_msi_init()
540 msi->pcie = pcie; in iproc_msi_init()
541 pcie->msi = msi; in iproc_msi_init()
542 msi->msi_addr = pcie->base_addr; in iproc_msi_init()
543 mutex_init(&msi->bitmap_lock); in iproc_msi_init()
544 msi->nr_cpus = num_possible_cpus(); in iproc_msi_init()
546 if (msi->nr_cpus == 1) in iproc_msi_init()
549 msi->nr_irqs = of_irq_count(node); in iproc_msi_init()
550 if (!msi->nr_irqs) { in iproc_msi_init()
551 dev_err(pcie->dev, "found no MSI GIC interrupt\n"); in iproc_msi_init()
552 return -ENODEV; in iproc_msi_init()
555 if (msi->nr_irqs > NR_HW_IRQS) { in iproc_msi_init()
556 dev_warn(pcie->dev, "too many MSI GIC interrupts defined %d\n", in iproc_msi_init()
557 msi->nr_irqs); in iproc_msi_init()
558 msi->nr_irqs = NR_HW_IRQS; in iproc_msi_init()
561 if (msi->nr_irqs < msi->nr_cpus) { in iproc_msi_init()
562 dev_err(pcie->dev, in iproc_msi_init()
564 return -EINVAL; in iproc_msi_init()
567 if (msi->nr_irqs % msi->nr_cpus != 0) { in iproc_msi_init()
568 msi->nr_irqs -= msi->nr_irqs % msi->nr_cpus; in iproc_msi_init()
569 dev_warn(pcie->dev, "Reducing number of interrupts to %d\n", in iproc_msi_init()
570 msi->nr_irqs); in iproc_msi_init()
573 switch (pcie->type) { in iproc_msi_init()
576 msi->reg_offsets = iproc_msi_reg_paxb; in iproc_msi_init()
577 msi->nr_eq_region = 1; in iproc_msi_init()
578 msi->nr_msi_region = 1; in iproc_msi_init()
581 msi->reg_offsets = iproc_msi_reg_paxc; in iproc_msi_init()
582 msi->nr_eq_region = msi->nr_irqs; in iproc_msi_init()
583 msi->nr_msi_region = msi->nr_irqs; in iproc_msi_init()
586 dev_err(pcie->dev, "incompatible iProc PCIe interface\n"); in iproc_msi_init()
587 return -EINVAL; in iproc_msi_init()
590 if (of_find_property(node, "brcm,pcie-msi-inten", NULL)) in iproc_msi_init()
591 msi->has_inten_reg = true; in iproc_msi_init()
593 msi->nr_msi_vecs = msi->nr_irqs * EQ_LEN; in iproc_msi_init()
594 msi->bitmap = devm_kcalloc(pcie->dev, BITS_TO_LONGS(msi->nr_msi_vecs), in iproc_msi_init()
595 sizeof(*msi->bitmap), GFP_KERNEL); in iproc_msi_init()
596 if (!msi->bitmap) in iproc_msi_init()
597 return -ENOMEM; in iproc_msi_init()
599 msi->grps = devm_kcalloc(pcie->dev, msi->nr_irqs, sizeof(*msi->grps), in iproc_msi_init()
601 if (!msi->grps) in iproc_msi_init()
602 return -ENOMEM; in iproc_msi_init()
604 for (i = 0; i < msi->nr_irqs; i++) { in iproc_msi_init()
608 dev_err(pcie->dev, "unable to parse/map interrupt\n"); in iproc_msi_init()
609 ret = -ENODEV; in iproc_msi_init()
612 msi->grps[i].gic_irq = irq; in iproc_msi_init()
613 msi->grps[i].msi = msi; in iproc_msi_init()
614 msi->grps[i].eq = i; in iproc_msi_init()
618 msi->eq_cpu = dma_alloc_coherent(pcie->dev, in iproc_msi_init()
619 msi->nr_eq_region * EQ_MEM_REGION_SIZE, in iproc_msi_init()
620 &msi->eq_dma, GFP_KERNEL); in iproc_msi_init()
621 if (!msi->eq_cpu) { in iproc_msi_init()
622 ret = -ENOMEM; in iproc_msi_init()
628 dev_err(pcie->dev, "failed to create MSI domains\n"); in iproc_msi_init()
632 for_each_online_cpu(cpu) { in iproc_msi_init()
633 ret = iproc_msi_irq_setup(msi, cpu); in iproc_msi_init()
643 for_each_online_cpu(cpu) in iproc_msi_init()
644 iproc_msi_irq_free(msi, cpu); in iproc_msi_init()
648 dma_free_coherent(pcie->dev, msi->nr_eq_region * EQ_MEM_REGION_SIZE, in iproc_msi_init()
649 msi->eq_cpu, msi->eq_dma); in iproc_msi_init()
652 for (i = 0; i < msi->nr_irqs; i++) { in iproc_msi_init()
653 if (msi->grps[i].gic_irq) in iproc_msi_init()
654 irq_dispose_mapping(msi->grps[i].gic_irq); in iproc_msi_init()
656 pcie->msi = NULL; in iproc_msi_init()
661 void iproc_msi_exit(struct iproc_pcie *pcie) in iproc_msi_exit() argument
663 struct iproc_msi *msi = pcie->msi; in iproc_msi_exit()
664 unsigned int i, cpu; in iproc_msi_exit() local
671 for_each_online_cpu(cpu) in iproc_msi_exit()
672 iproc_msi_irq_free(msi, cpu); in iproc_msi_exit()
676 dma_free_coherent(pcie->dev, msi->nr_eq_region * EQ_MEM_REGION_SIZE, in iproc_msi_exit()
677 msi->eq_cpu, msi->eq_dma); in iproc_msi_exit()
679 for (i = 0; i < msi->nr_irqs; i++) { in iproc_msi_exit()
680 if (msi->grps[i].gic_irq) in iproc_msi_exit()
681 irq_dispose_mapping(msi->grps[i].gic_irq); in iproc_msi_exit()