powerpc/wsp: Add MSI support for PCI on PowerEN (f9a71e0f) · Commits · e / devices / android_kernel_samsung_universal8895

arch/powerpc/platforms/wsp/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -5,3 +5,4 @@ obj-$(CONFIG_PPC_PSR2) += psr2.o opb_pic.o
		obj-$(CONFIG_PPC_WSP) += scom_wsp.o
		obj-$(CONFIG_SMP) += smp.o scom_smp.o
		obj-$(CONFIG_PCI) += wsp_pci.o
		obj-$(CONFIG_PCI_MSI) += msi.o
		No newline at end of file

arch/powerpc/platforms/wsp/ics.c

+48 −0

Original line number	Diff line number	Diff line
		@@ -710,3 +710,51 @@ void __init wsp_init_irq(void)
		/* We need to patch our irq chip's EOI to point to the right ICP */
		wsp_irq_chip.irq_eoi = icp_ops->eoi;
		}

		#ifdef CONFIG_PCI_MSI
		static void wsp_ics_msi_unmask_irq(struct irq_data *d)
		{
		wsp_chip_unmask_irq(d);
		unmask_msi_irq(d);
		}

		static unsigned int wsp_ics_msi_startup(struct irq_data *d)
		{
		wsp_ics_msi_unmask_irq(d);
		return 0;
		}

		static void wsp_ics_msi_mask_irq(struct irq_data *d)
		{
		mask_msi_irq(d);
		wsp_chip_mask_irq(d);
		}

		/*
		* we do it this way because we reassinge default EOI handling in
		* irq_init() above
		*/
		static void wsp_ics_eoi(struct irq_data *data)
		{
		wsp_irq_chip.irq_eoi(data);
		}

		static struct irq_chip wsp_ics_msi = {
		.name = "WSP ICS MSI",
		.irq_startup = wsp_ics_msi_startup,
		.irq_mask = wsp_ics_msi_mask_irq,
		.irq_unmask = wsp_ics_msi_unmask_irq,
		.irq_eoi = wsp_ics_eoi,
		.irq_set_affinity = wsp_chip_set_affinity
		};

		void wsp_ics_set_msi_chip(unsigned int irq)
		{
		irq_set_chip(irq, &wsp_ics_msi);
		}

		void wsp_ics_set_std_chip(unsigned int irq)
		{
		irq_set_chip(irq, &wsp_irq_chip);
		}
		#endif /* CONFIG_PCI_MSI */

arch/powerpc/platforms/wsp/ics.h

+5 −0

Original line number	Diff line number	Diff line
		@@ -17,4 +17,9 @@ extern void wsp_init_irq(void);
		extern int wsp_ics_alloc_irq(struct device_node *dn, int num);
		extern void wsp_ics_free_irq(struct device_node *dn, unsigned int irq);

		#ifdef CONFIG_PCI_MSI
		extern void wsp_ics_set_msi_chip(unsigned int irq);
		extern void wsp_ics_set_std_chip(unsigned int irq);
		#endif /* CONFIG_PCI_MSI */

		#endif /* __ICS_H */

arch/powerpc/platforms/wsp/msi.c

0 → 100644

+102 −0

Original line number	Diff line number	Diff line
		/*
		* Copyright 2011 Michael Ellerman, IBM Corp.
		*
		* This program is free software; you can redistribute it and/or
		* modify it under the terms of the GNU General Public License
		* as published by the Free Software Foundation; either version
		* 2 of the License, or (at your option) any later version.
		*/

		#include <linux/kernel.h>
		#include <linux/pci.h>
		#include <linux/msi.h>
		#include <linux/irq.h>
		#include <linux/interrupt.h>

		#include "msi.h"
		#include "ics.h"
		#include "wsp_pci.h"

		/* Magic addresses for 32 & 64-bit MSIs with hardcoded MVE 0 */
		#define MSI_ADDR_32 0xFFFF0000ul
		#define MSI_ADDR_64 0x1000000000000000ul

		int wsp_setup_msi_irqs(struct pci_dev *dev, int nvec, int type)
		{
		struct pci_controller *phb;
		struct msi_desc *entry;
		struct msi_msg msg;
		unsigned int virq;
		int hwirq;

		phb = pci_bus_to_host(dev->bus);
		if (!phb)
		return -ENOENT;

		entry = list_first_entry(&dev->msi_list, struct msi_desc, list);
		if (entry->msi_attrib.is_64) {
		msg.address_lo = 0;
		msg.address_hi = MSI_ADDR_64 >> 32;
		} else {
		msg.address_lo = MSI_ADDR_32;
		msg.address_hi = 0;
		}

		list_for_each_entry(entry, &dev->msi_list, list) {
		hwirq = wsp_ics_alloc_irq(phb->dn, 1);
		if (hwirq < 0) {
		dev_warn(&dev->dev, "wsp_msi: hwirq alloc failed!\n");
		return hwirq;
		}

		virq = irq_create_mapping(NULL, hwirq);
		if (virq == NO_IRQ) {
		dev_warn(&dev->dev, "wsp_msi: virq alloc failed!\n");
		return -1;
		}

		dev_dbg(&dev->dev, "wsp_msi: allocated irq %#x/%#x\n",
		hwirq, virq);

		wsp_ics_set_msi_chip(virq);
		irq_set_msi_desc(virq, entry);
		msg.data = hwirq & XIVE_ADDR_MASK;
		write_msi_msg(virq, &msg);
		}

		return 0;
		}

		void wsp_teardown_msi_irqs(struct pci_dev *dev)
		{
		struct pci_controller *phb;
		struct msi_desc *entry;
		int hwirq;

		phb = pci_bus_to_host(dev->bus);

		dev_dbg(&dev->dev, "wsp_msi: tearing down msi irqs\n");

		list_for_each_entry(entry, &dev->msi_list, list) {
		if (entry->irq == NO_IRQ)
		continue;

		irq_set_msi_desc(entry->irq, NULL);
		wsp_ics_set_std_chip(entry->irq);

		hwirq = virq_to_hw(entry->irq);
		/* In this order to avoid racing with irq_create_mapping() */
		irq_dispose_mapping(entry->irq);
		wsp_ics_free_irq(phb->dn, hwirq);
		}
		}

		void wsp_setup_phb_msi(struct pci_controller *phb)
		{
		/* Create a single MVE at offset 0 that matches everything */
		out_be64(phb->cfg_data + PCIE_REG_IODA_ADDR, PCIE_REG_IODA_AD_TBL_MVT);
		out_be64(phb->cfg_data + PCIE_REG_IODA_DATA0, 1ull << 63);

		ppc_md.setup_msi_irqs = wsp_setup_msi_irqs;
		ppc_md.teardown_msi_irqs = wsp_teardown_msi_irqs;
		}

arch/powerpc/platforms/wsp/msi.h

0 → 100644

+19 −0

Original line number	Diff line number	Diff line
		/*
		* Copyright 2011 Michael Ellerman, IBM Corp.
		*
		* This program is free software; you can redistribute it and/or
		* modify it under the terms of the GNU General Public License
		* as published by the Free Software Foundation; either version
		* 2 of the License, or (at your option) any later version.
		*/

		#ifndef __WSP_MSI_H
		#define __WSP_MSI_H

		#ifdef CONFIG_PCI_MSI
		extern void wsp_setup_phb_msi(struct pci_controller *phb);
		#else
		static inline void wsp_setup_phb_msi(struct pci_controller *phb) { }
		#endif

		#endif /* __WSP_MSI_H */