62 	struct iproc_msi *msi;  member
128 static inline u32 iproc_msi_read_reg(struct iproc_msi *msi,  in iproc_msi_read_reg()  argument
132 	struct iproc_pcie *pcie = msi->pcie;  in iproc_msi_read_reg()
134 	return readl_relaxed(pcie->base + msi->reg_offsets[eq][reg]);  in iproc_msi_read_reg()
137 static inline void iproc_msi_write_reg(struct iproc_msi *msi,  in iproc_msi_write_reg()  argument
141 	struct iproc_pcie *pcie = msi->pcie;  in iproc_msi_write_reg()
143 	writel_relaxed(val, pcie->base + msi->reg_offsets[eq][reg]);  in iproc_msi_write_reg()
146 static inline u32 hwirq_to_group(struct iproc_msi *msi, unsigned long hwirq)  in hwirq_to_group()  argument
148 	return (hwirq % msi->nr_irqs);  in hwirq_to_group()
151 static inline unsigned int iproc_msi_addr_offset(struct iproc_msi *msi,  in iproc_msi_addr_offset()  argument
154 	if (msi->nr_msi_region > 1)  in iproc_msi_addr_offset()
155 		return hwirq_to_group(msi, hwirq) * MSI_MEM_REGION_SIZE;  in iproc_msi_addr_offset()
157 		return hwirq_to_group(msi, hwirq) * sizeof(u32);  in iproc_msi_addr_offset()
160 static inline unsigned int iproc_msi_eq_offset(struct iproc_msi *msi, u32 eq)  in iproc_msi_eq_offset()  argument
162 	if (msi->nr_eq_region > 1)  in iproc_msi_eq_offset()
195 static inline int hwirq_to_cpu(struct iproc_msi *msi, unsigned long hwirq)  in hwirq_to_cpu()  argument
197 	return (hwirq % msi->nr_cpus);  in hwirq_to_cpu()
200 static inline unsigned long hwirq_to_canonical_hwirq(struct iproc_msi *msi,  in hwirq_to_canonical_hwirq()  argument
203 	return (hwirq - hwirq_to_cpu(msi, hwirq));  in hwirq_to_canonical_hwirq()
209 	struct iproc_msi *msi = irq_data_get_irq_chip_data(data);  in iproc_msi_irq_set_affinity()  local
214 	curr_cpu = hwirq_to_cpu(msi, data->hwirq);  in iproc_msi_irq_set_affinity()
219 		data->hwirq = hwirq_to_canonical_hwirq(msi, data->hwirq) + target_cpu;  in iproc_msi_irq_set_affinity()
231 	struct iproc_msi *msi = irq_data_get_irq_chip_data(data);  in iproc_msi_irq_compose_msi_msg()  local
234 	addr = msi->msi_addr + iproc_msi_addr_offset(msi, data->hwirq);  in iproc_msi_irq_compose_msi_msg()
250 	struct iproc_msi *msi = domain->host_data;  in iproc_msi_irq_domain_alloc()  local
253 	if (msi->nr_cpus > 1 && nr_irqs > 1)  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()
284 	struct iproc_msi *msi = irq_data_get_irq_chip_data(data);  in iproc_msi_irq_domain_free()  local
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()
303 static inline u32 decode_msi_hwirq(struct iproc_msi *msi, u32 eq, u32 head)  in decode_msi_hwirq()  argument
309 	offs = iproc_msi_eq_offset(msi, eq) + head * sizeof(u32);  in decode_msi_hwirq()
310 	msg = (u32 __iomem *)(msi->eq_cpu + offs);  in decode_msi_hwirq()
319 	return hwirq_to_canonical_hwirq(msi, hwirq);  in decode_msi_hwirq()
326 	struct iproc_msi *msi;  in iproc_msi_handler()  local
333 	msi = grp->msi;  in iproc_msi_handler()
346 	head = iproc_msi_read_reg(msi, IPROC_MSI_EQ_HEAD,  in iproc_msi_handler()
349 		tail = iproc_msi_read_reg(msi, IPROC_MSI_EQ_TAIL,  in iproc_msi_handler()
363 			hwirq = decode_msi_hwirq(msi, eq, head);  in iproc_msi_handler()
364 			generic_handle_domain_irq(msi->inner_domain, hwirq);  in iproc_msi_handler()
374 		iproc_msi_write_reg(msi, IPROC_MSI_EQ_HEAD, eq, head);  in iproc_msi_handler()
385 static void iproc_msi_enable(struct iproc_msi *msi)  in iproc_msi_enable()  argument
391 	for (i = 0; i < msi->nr_eq_region; i++) {  in iproc_msi_enable()
392 		dma_addr_t addr = msi->eq_dma + (i * EQ_MEM_REGION_SIZE);  in iproc_msi_enable()
394 		iproc_msi_write_reg(msi, IPROC_MSI_EQ_PAGE, i,  in iproc_msi_enable()
396 		iproc_msi_write_reg(msi, IPROC_MSI_EQ_PAGE_UPPER, i,  in iproc_msi_enable()
401 	for (i = 0; i < msi->nr_msi_region; i++) {  in iproc_msi_enable()
402 		phys_addr_t addr = msi->msi_addr + (i * MSI_MEM_REGION_SIZE);  in iproc_msi_enable()
404 		iproc_msi_write_reg(msi, IPROC_MSI_PAGE, i,  in iproc_msi_enable()
406 		iproc_msi_write_reg(msi, IPROC_MSI_PAGE_UPPER, i,  in iproc_msi_enable()
410 	for (eq = 0; eq < msi->nr_irqs; eq++) {  in iproc_msi_enable()
414 		iproc_msi_write_reg(msi, IPROC_MSI_CTRL, eq, val);  in iproc_msi_enable()
420 		if (msi->has_inten_reg) {  in iproc_msi_enable()
421 			val = iproc_msi_read_reg(msi, IPROC_MSI_INTS_EN, eq);  in iproc_msi_enable()
423 			iproc_msi_write_reg(msi, IPROC_MSI_INTS_EN, eq, val);  in iproc_msi_enable()
428 static void iproc_msi_disable(struct iproc_msi *msi)  in iproc_msi_disable()  argument
432 	for (eq = 0; eq < msi->nr_irqs; eq++) {  in iproc_msi_disable()
433 		if (msi->has_inten_reg) {  in iproc_msi_disable()
434 			val = iproc_msi_read_reg(msi, IPROC_MSI_INTS_EN, eq);  in iproc_msi_disable()
436 			iproc_msi_write_reg(msi, IPROC_MSI_INTS_EN, eq, val);  in iproc_msi_disable()
439 		val = iproc_msi_read_reg(msi, IPROC_MSI_CTRL, eq);  in iproc_msi_disable()
442 		iproc_msi_write_reg(msi, IPROC_MSI_CTRL, eq, val);  in iproc_msi_disable()
447 				   struct iproc_msi *msi)  in iproc_msi_alloc_domains()  argument
449 	msi->inner_domain = irq_domain_add_linear(NULL, msi->nr_msi_vecs,  in iproc_msi_alloc_domains()
450 						  &msi_domain_ops, msi);  in iproc_msi_alloc_domains()
451 	if (!msi->inner_domain)  in iproc_msi_alloc_domains()
454 	msi->msi_domain = pci_msi_create_irq_domain(of_node_to_fwnode(node),  in iproc_msi_alloc_domains()
456 						    msi->inner_domain);  in iproc_msi_alloc_domains()
457 	if (!msi->msi_domain) {  in iproc_msi_alloc_domains()
458 		irq_domain_remove(msi->inner_domain);  in iproc_msi_alloc_domains()
465 static void iproc_msi_free_domains(struct iproc_msi *msi)  in iproc_msi_free_domains()  argument
467 	if (msi->msi_domain)  in iproc_msi_free_domains()
468 		irq_domain_remove(msi->msi_domain);  in iproc_msi_free_domains()
470 	if (msi->inner_domain)  in iproc_msi_free_domains()
471 		irq_domain_remove(msi->inner_domain);  in iproc_msi_free_domains()
474 static void iproc_msi_irq_free(struct iproc_msi *msi, unsigned int cpu)  in iproc_msi_irq_free()  argument
478 	for (i = cpu; i < msi->nr_irqs; i += msi->nr_cpus) {  in iproc_msi_irq_free()
479 		irq_set_chained_handler_and_data(msi->grps[i].gic_irq,  in iproc_msi_irq_free()
484 static int iproc_msi_irq_setup(struct iproc_msi *msi, unsigned int cpu)  in iproc_msi_irq_setup()  argument
488 	struct iproc_pcie *pcie = msi->pcie;  in iproc_msi_irq_setup()
490 	for (i = cpu; i < msi->nr_irqs; i += msi->nr_cpus) {  in iproc_msi_irq_setup()
491 		irq_set_chained_handler_and_data(msi->grps[i].gic_irq,  in iproc_msi_irq_setup()
493 						 &msi->grps[i]);  in iproc_msi_irq_setup()
498 			ret = irq_set_affinity(msi->grps[i].gic_irq, mask);  in iproc_msi_irq_setup()
502 					msi->grps[i].gic_irq);  in iproc_msi_irq_setup()
511 			iproc_msi_irq_free(msi, cpu);  in iproc_msi_irq_setup()
521 	struct iproc_msi *msi;  in iproc_msi_init()  local
531 	if (pcie->msi)  in iproc_msi_init()
534 	msi = devm_kzalloc(pcie->dev, sizeof(*msi), GFP_KERNEL);  in iproc_msi_init()
535 	if (!msi)  in iproc_msi_init()
538 	msi->pcie = pcie;  in iproc_msi_init()
539 	pcie->msi = msi;  in iproc_msi_init()
540 	msi->msi_addr = pcie->base_addr;  in iproc_msi_init()
541 	mutex_init(&msi->bitmap_lock);  in iproc_msi_init()
542 	msi->nr_cpus = num_possible_cpus();  in iproc_msi_init()
544 	if (msi->nr_cpus == 1)  in iproc_msi_init()
547 	msi->nr_irqs = of_irq_count(node);  in iproc_msi_init()
548 	if (!msi->nr_irqs) {  in iproc_msi_init()
553 	if (msi->nr_irqs > NR_HW_IRQS) {  in iproc_msi_init()
555 			 msi->nr_irqs);  in iproc_msi_init()
556 		msi->nr_irqs = NR_HW_IRQS;  in iproc_msi_init()
559 	if (msi->nr_irqs < msi->nr_cpus) {  in iproc_msi_init()
565 	if (msi->nr_irqs % msi->nr_cpus != 0) {  in iproc_msi_init()
566 		msi->nr_irqs -= msi->nr_irqs % msi->nr_cpus;  in iproc_msi_init()
568 			 msi->nr_irqs);  in iproc_msi_init()
574 		msi->reg_offsets = iproc_msi_reg_paxb;  in iproc_msi_init()
575 		msi->nr_eq_region = 1;  in iproc_msi_init()
576 		msi->nr_msi_region = 1;  in iproc_msi_init()
579 		msi->reg_offsets = iproc_msi_reg_paxc;  in iproc_msi_init()
580 		msi->nr_eq_region = msi->nr_irqs;  in iproc_msi_init()
581 		msi->nr_msi_region = msi->nr_irqs;  in iproc_msi_init()
588 	msi->has_inten_reg = of_property_read_bool(node, "brcm,pcie-msi-inten");  in iproc_msi_init()
590 	msi->nr_msi_vecs = msi->nr_irqs * EQ_LEN;  in iproc_msi_init()
591 	msi->bitmap = devm_bitmap_zalloc(pcie->dev, msi->nr_msi_vecs,  in iproc_msi_init()
593 	if (!msi->bitmap)  in iproc_msi_init()
596 	msi->grps = devm_kcalloc(pcie->dev, msi->nr_irqs, sizeof(*msi->grps),  in iproc_msi_init()
598 	if (!msi->grps)  in iproc_msi_init()
601 	for (i = 0; i < msi->nr_irqs; i++) {  in iproc_msi_init()
609 		msi->grps[i].gic_irq = irq;  in iproc_msi_init()
610 		msi->grps[i].msi = msi;  in iproc_msi_init()
611 		msi->grps[i].eq = i;  in iproc_msi_init()
615 	msi->eq_cpu = dma_alloc_coherent(pcie->dev,  in iproc_msi_init()
616 					 msi->nr_eq_region * EQ_MEM_REGION_SIZE,  in iproc_msi_init()
617 					 &msi->eq_dma, GFP_KERNEL);  in iproc_msi_init()
618 	if (!msi->eq_cpu) {  in iproc_msi_init()
623 	ret = iproc_msi_alloc_domains(node, msi);  in iproc_msi_init()
630 		ret = iproc_msi_irq_setup(msi, cpu);  in iproc_msi_init()
635 	iproc_msi_enable(msi);  in iproc_msi_init()
641 		iproc_msi_irq_free(msi, cpu);  in iproc_msi_init()
642 	iproc_msi_free_domains(msi);  in iproc_msi_init()
645 	dma_free_coherent(pcie->dev, msi->nr_eq_region * EQ_MEM_REGION_SIZE,  in iproc_msi_init()
646 			  msi->eq_cpu, msi->eq_dma);  in iproc_msi_init()
649 	for (i = 0; i < msi->nr_irqs; i++) {  in iproc_msi_init()
650 		if (msi->grps[i].gic_irq)  in iproc_msi_init()
651 			irq_dispose_mapping(msi->grps[i].gic_irq);  in iproc_msi_init()
653 	pcie->msi = NULL;  in iproc_msi_init()
660 	struct iproc_msi *msi = pcie->msi;  in iproc_msi_exit()  local
663 	if (!msi)  in iproc_msi_exit()
666 	iproc_msi_disable(msi);  in iproc_msi_exit()
669 		iproc_msi_irq_free(msi, cpu);  in iproc_msi_exit()
671 	iproc_msi_free_domains(msi);  in iproc_msi_exit()
673 	dma_free_coherent(pcie->dev, msi->nr_eq_region * EQ_MEM_REGION_SIZE,  in iproc_msi_exit()
674 			  msi->eq_cpu, msi->eq_dma);  in iproc_msi_exit()
676 	for (i = 0; i < msi->nr_irqs; i++) {  in iproc_msi_exit()
677 		if (msi->grps[i].gic_irq)  in iproc_msi_exit()
678 			irq_dispose_mapping(msi->grps[i].gic_irq);  in iproc_msi_exit()