[net-next-2.6.git] / arch / ia64 / sn / kernel / msi_sn.c

/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (C) 2006 Silicon Graphics, Inc.  All Rights Reserved.
 */

#include <linux/types.h>
#include <linux/irq.h>
#include <linux/pci.h>
#include <linux/cpumask.h>
#include <linux/msi.h>

#include <asm/sn/addrs.h>
#include <asm/sn/intr.h>
#include <asm/sn/pcibus_provider_defs.h>
#include <asm/sn/pcidev.h>
#include <asm/sn/nodepda.h>

struct sn_msi_info {
	u64 pci_addr;
	struct sn_irq_info *sn_irq_info;
};

static struct sn_msi_info sn_msi_info[NR_IRQS];

static struct irq_chip sn_msi_chip;

void sn_teardown_msi_irq(unsigned int irq)
{
	nasid_t nasid;
	int widget;
	struct pci_dev *pdev;
	struct pcidev_info *sn_pdev;
	struct sn_irq_info *sn_irq_info;
	struct pcibus_bussoft *bussoft;
	struct sn_pcibus_provider *provider;

	sn_irq_info = sn_msi_info[irq].sn_irq_info;
	if (sn_irq_info == NULL || sn_irq_info->irq_int_bit >= 0)
		return;

	sn_pdev = (struct pcidev_info *)sn_irq_info->irq_pciioinfo;
	pdev = sn_pdev->pdi_linux_pcidev;
	provider = SN_PCIDEV_BUSPROVIDER(pdev);

	(*provider->dma_unmap)(pdev,
			       sn_msi_info[irq].pci_addr,
			       PCI_DMA_FROMDEVICE);
	sn_msi_info[irq].pci_addr = 0;

	bussoft = SN_PCIDEV_BUSSOFT(pdev);
	nasid = NASID_GET(bussoft->bs_base);
	widget = (nasid & 1) ?
			TIO_SWIN_WIDGETNUM(bussoft->bs_base) :
			SWIN_WIDGETNUM(bussoft->bs_base);

	sn_intr_free(nasid, widget, sn_irq_info);
	sn_msi_info[irq].sn_irq_info = NULL;

	return;
}

int sn_setup_msi_irq(unsigned int irq, struct pci_dev *pdev)
{
	struct msi_msg msg;
	struct msi_desc *entry;
	int widget;
	int status;
	nasid_t nasid;
	u64 bus_addr;
	struct sn_irq_info *sn_irq_info;
	struct pcibus_bussoft *bussoft = SN_PCIDEV_BUSSOFT(pdev);
	struct sn_pcibus_provider *provider = SN_PCIDEV_BUSPROVIDER(pdev);

	entry = get_irq_msi(irq);
	if (!entry->msi_attrib.is_64)
		return -EINVAL;

	if (bussoft == NULL)
		return -EINVAL;

	if (provider == NULL || provider->dma_map_consistent == NULL)
		return -EINVAL;

	/*
	 * Set up the vector plumbing.  Let the prom (via sn_intr_alloc)
	 * decide which cpu to direct this msi at by default.
	 */

	nasid = NASID_GET(bussoft->bs_base);
	widget = (nasid & 1) ?
			TIO_SWIN_WIDGETNUM(bussoft->bs_base) :
			SWIN_WIDGETNUM(bussoft->bs_base);

	sn_irq_info = kzalloc(sizeof(struct sn_irq_info), GFP_KERNEL);
	if (! sn_irq_info)
		return -ENOMEM;

	status = sn_intr_alloc(nasid, widget, sn_irq_info, irq, -1, -1);
	if (status) {
		kfree(sn_irq_info);
		return -ENOMEM;
	}

	sn_irq_info->irq_int_bit = -1;		/* mark this as an MSI irq */
	sn_irq_fixup(pdev, sn_irq_info);

	/* Prom probably should fill these in, but doesn't ... */
	sn_irq_info->irq_bridge_type = bussoft->bs_asic_type;
	sn_irq_info->irq_bridge = (void *)bussoft->bs_base;

	/*
	 * Map the xio address into bus space
	 */
	bus_addr = (*provider->dma_map_consistent)(pdev,
					sn_irq_info->irq_xtalkaddr,
					sizeof(sn_irq_info->irq_xtalkaddr),
					SN_DMA_MSI|SN_DMA_ADDR_XIO);
	if (! bus_addr) {
		sn_intr_free(nasid, widget, sn_irq_info);
		kfree(sn_irq_info);
		return -ENOMEM;
	}

	sn_msi_info[irq].sn_irq_info = sn_irq_info;
	sn_msi_info[irq].pci_addr = bus_addr;

	msg.address_hi = (u32)(bus_addr >> 32);
	msg.address_lo = (u32)(bus_addr & 0x00000000ffffffff);

	/*
	 * In the SN platform, bit 16 is a "send vector" bit which
	 * must be present in order to move the vector through the system.
	 */
	msg.data = 0x100 + irq;

	write_msi_msg(irq, &msg);
	set_irq_chip_and_handler(irq, &sn_msi_chip, handle_edge_irq);

	return 0;
}

#ifdef CONFIG_SMP
static void sn_set_msi_irq_affinity(unsigned int irq, cpumask_t cpu_mask)
{
	struct msi_msg msg;
	int slice;
	nasid_t nasid;
	u64 bus_addr;
	struct pci_dev *pdev;
	struct pcidev_info *sn_pdev;
	struct sn_irq_info *sn_irq_info;
	struct sn_irq_info *new_irq_info;
	struct sn_pcibus_provider *provider;
	unsigned int cpu;

	cpu = first_cpu(cpu_mask);
	sn_irq_info = sn_msi_info[irq].sn_irq_info;
	if (sn_irq_info == NULL || sn_irq_info->irq_int_bit >= 0)
		return;

	/*
	 * Release XIO resources for the old MSI PCI address
	 */

	read_msi_msg(irq, &msg);
        sn_pdev = (struct pcidev_info *)sn_irq_info->irq_pciioinfo;
	pdev = sn_pdev->pdi_linux_pcidev;
	provider = SN_PCIDEV_BUSPROVIDER(pdev);

	bus_addr = (u64)(msg.address_hi) << 32 | (u64)(msg.address_lo);
	(*provider->dma_unmap)(pdev, bus_addr, PCI_DMA_FROMDEVICE);
	sn_msi_info[irq].pci_addr = 0;

	nasid = cpuid_to_nasid(cpu);
	slice = cpuid_to_slice(cpu);

	new_irq_info = sn_retarget_vector(sn_irq_info, nasid, slice);
	sn_msi_info[irq].sn_irq_info = new_irq_info;
	if (new_irq_info == NULL)
		return;

	/*
	 * Map the xio address into bus space
	 */

	bus_addr = (*provider->dma_map_consistent)(pdev,
					new_irq_info->irq_xtalkaddr,
					sizeof(new_irq_info->irq_xtalkaddr),
					SN_DMA_MSI|SN_DMA_ADDR_XIO);

	sn_msi_info[irq].pci_addr = bus_addr;
	msg.address_hi = (u32)(bus_addr >> 32);
	msg.address_lo = (u32)(bus_addr & 0x00000000ffffffff);

	write_msi_msg(irq, &msg);
	set_native_irq_info(irq, cpu_mask);
}
#endif /* CONFIG_SMP */

static void sn_ack_msi_irq(unsigned int irq)
{
	move_native_irq(irq);
	ia64_eoi();
}

static int sn_msi_retrigger_irq(unsigned int irq)
{
	unsigned int vector = irq;
	ia64_resend_irq(vector);

	return 1;
}

static struct irq_chip sn_msi_chip = {
	.name		= "PCI-MSI",
	.mask		= mask_msi_irq,
	.unmask		= unmask_msi_irq,
	.ack		= sn_ack_msi_irq,
#ifdef CONFIG_SMP
	.set_affinity	= sn_set_msi_irq_affinity,
#endif
	.retrigger	= sn_msi_retrigger_irq,
};
Commit	Line	Data
fd58e55f MM	1	/*
	2	* This file is subject to the terms and conditions of the GNU General Public
	3	* License. See the file "COPYING" in the main directory of this archive
	4	* for more details.
	5	*
	6	* Copyright (C) 2006 Silicon Graphics, Inc. All Rights Reserved.
	7	*/
	8
83821d3f	9	#include <linux/types.h>
3b7d1921	10	#include <linux/irq.h>
83821d3f MM	11	#include <linux/pci.h>
83821d3f MM	12	#include <linux/cpumask.h>
3b7d1921	13	#include <linux/msi.h>
83821d3f MM	14
	15	#include <asm/sn/addrs.h>
	16	#include <asm/sn/intr.h>
	17	#include <asm/sn/pcibus_provider_defs.h>
	18	#include <asm/sn/pcidev.h>
	19	#include <asm/sn/nodepda.h>
	20
83821d3f MM	21	struct sn_msi_info {
	22	u64 pci_addr;
	23	struct sn_irq_info *sn_irq_info;
	24	};
	25
3b7d1921 EB	26	static struct sn_msi_info sn_msi_info[NR_IRQS];
	27
	28	static struct irq_chip sn_msi_chip;
83821d3f	29
3b7d1921	30	void sn_teardown_msi_irq(unsigned int irq)
83821d3f MM	31	{
	32	nasid_t nasid;
	33	int widget;
	34	struct pci_dev *pdev;
	35	struct pcidev_info *sn_pdev;
	36	struct sn_irq_info *sn_irq_info;
	37	struct pcibus_bussoft *bussoft;
	38	struct sn_pcibus_provider *provider;
	39
38bc0361	40	sn_irq_info = sn_msi_info[irq].sn_irq_info;
83821d3f MM	41	if (sn_irq_info == NULL \|\| sn_irq_info->irq_int_bit >= 0)
	42	return;
	43
	44	sn_pdev = (struct pcidev_info *)sn_irq_info->irq_pciioinfo;
	45	pdev = sn_pdev->pdi_linux_pcidev;
	46	provider = SN_PCIDEV_BUSPROVIDER(pdev);
	47
	48	(*provider->dma_unmap)(pdev,
38bc0361	49	sn_msi_info[irq].pci_addr,
83821d3f	50	PCI_DMA_FROMDEVICE);
38bc0361	51	sn_msi_info[irq].pci_addr = 0;
83821d3f MM	52
	53	bussoft = SN_PCIDEV_BUSSOFT(pdev);
	54	nasid = NASID_GET(bussoft->bs_base);
	55	widget = (nasid & 1) ?
	56	TIO_SWIN_WIDGETNUM(bussoft->bs_base) :
	57	SWIN_WIDGETNUM(bussoft->bs_base);
	58
	59	sn_intr_free(nasid, widget, sn_irq_info);
38bc0361	60	sn_msi_info[irq].sn_irq_info = NULL;
83821d3f MM	61
	62	return;
	63	}
fd58e55f	64
3b7d1921	65	int sn_setup_msi_irq(unsigned int irq, struct pci_dev *pdev)
fd58e55f	66	{
3b7d1921 EB	67	struct msi_msg msg;
3b7d1921 EB	68	struct msi_desc *entry;
83821d3f MM	69	int widget;
	70	int status;
	71	nasid_t nasid;
	72	u64 bus_addr;
	73	struct sn_irq_info *sn_irq_info;
	74	struct pcibus_bussoft *bussoft = SN_PCIDEV_BUSSOFT(pdev);
	75	struct sn_pcibus_provider *provider = SN_PCIDEV_BUSPROVIDER(pdev);
	76
5b912c10	77	entry = get_irq_msi(irq);
3b7d1921 EB	78	if (!entry->msi_attrib.is_64)
	79	return -EINVAL;
	80
83821d3f MM	81	if (bussoft == NULL)
	82	return -EINVAL;
	83
	84	if (provider == NULL \|\| provider->dma_map_consistent == NULL)
	85	return -EINVAL;
	86
	87	/*
	88	* Set up the vector plumbing. Let the prom (via sn_intr_alloc)
	89	* decide which cpu to direct this msi at by default.
	90	*/
	91
	92	nasid = NASID_GET(bussoft->bs_base);
	93	widget = (nasid & 1) ?
	94	TIO_SWIN_WIDGETNUM(bussoft->bs_base) :
	95	SWIN_WIDGETNUM(bussoft->bs_base);
	96
	97	sn_irq_info = kzalloc(sizeof(struct sn_irq_info), GFP_KERNEL);
	98	if (! sn_irq_info)
	99	return -ENOMEM;
	100
38bc0361	101	status = sn_intr_alloc(nasid, widget, sn_irq_info, irq, -1, -1);
83821d3f MM	102	if (status) {
	103	kfree(sn_irq_info);
	104	return -ENOMEM;
	105	}
	106
	107	sn_irq_info->irq_int_bit = -1; /* mark this as an MSI irq */
	108	sn_irq_fixup(pdev, sn_irq_info);
	109
	110	/* Prom probably should fill these in, but doesn't ... */
	111	sn_irq_info->irq_bridge_type = bussoft->bs_asic_type;
	112	sn_irq_info->irq_bridge = (void *)bussoft->bs_base;
	113
fd58e55f	114	/*
83821d3f	115	* Map the xio address into bus space
fd58e55f	116	*/
83821d3f MM	117	bus_addr = (*provider->dma_map_consistent)(pdev,
	118	sn_irq_info->irq_xtalkaddr,
	119	sizeof(sn_irq_info->irq_xtalkaddr),
	120	SN_DMA_MSI\|SN_DMA_ADDR_XIO);
	121	if (! bus_addr) {
	122	sn_intr_free(nasid, widget, sn_irq_info);
	123	kfree(sn_irq_info);
	124	return -ENOMEM;
	125	}
	126
38bc0361 EB	127	sn_msi_info[irq].sn_irq_info = sn_irq_info;
38bc0361 EB	128	sn_msi_info[irq].pci_addr = bus_addr;
83821d3f	129
3b7d1921 EB	130	msg.address_hi = (u32)(bus_addr >> 32);
3b7d1921 EB	131	msg.address_lo = (u32)(bus_addr & 0x00000000ffffffff);
83821d3f MM	132
	133	/*
	134	* In the SN platform, bit 16 is a "send vector" bit which
	135	* must be present in order to move the vector through the system.
	136	*/
3b7d1921	137	msg.data = 0x100 + irq;
83821d3f	138
3b7d1921 EB	139	write_msi_msg(irq, &msg);
	140	set_irq_chip_and_handler(irq, &sn_msi_chip, handle_edge_irq);
	141
83821d3f MM	142	return 0;
	143	}
	144
3b7d1921 EB	145	#ifdef CONFIG_SMP
3b7d1921 EB	146	static void sn_set_msi_irq_affinity(unsigned int irq, cpumask_t cpu_mask)
83821d3f	147	{
3b7d1921	148	struct msi_msg msg;
83821d3f MM	149	int slice;
	150	nasid_t nasid;
	151	u64 bus_addr;
	152	struct pci_dev *pdev;
	153	struct pcidev_info *sn_pdev;
	154	struct sn_irq_info *sn_irq_info;
	155	struct sn_irq_info *new_irq_info;
	156	struct sn_pcibus_provider *provider;
38bc0361	157	unsigned int cpu;
83821d3f	158
38bc0361 EB	159	cpu = first_cpu(cpu_mask);
38bc0361 EB	160	sn_irq_info = sn_msi_info[irq].sn_irq_info;
83821d3f MM	161	if (sn_irq_info == NULL \|\| sn_irq_info->irq_int_bit >= 0)
	162	return;
	163
	164	/*
	165	* Release XIO resources for the old MSI PCI address
	166	*/
	167
3b7d1921	168	read_msi_msg(irq, &msg);
83821d3f MM	169	sn_pdev = (struct pcidev_info *)sn_irq_info->irq_pciioinfo;
	170	pdev = sn_pdev->pdi_linux_pcidev;
	171	provider = SN_PCIDEV_BUSPROVIDER(pdev);
	172
3b7d1921	173	bus_addr = (u64)(msg.address_hi) << 32 \| (u64)(msg.address_lo);
83821d3f	174	(*provider->dma_unmap)(pdev, bus_addr, PCI_DMA_FROMDEVICE);
38bc0361	175	sn_msi_info[irq].pci_addr = 0;
83821d3f MM	176
	177	nasid = cpuid_to_nasid(cpu);
	178	slice = cpuid_to_slice(cpu);
	179
	180	new_irq_info = sn_retarget_vector(sn_irq_info, nasid, slice);
38bc0361	181	sn_msi_info[irq].sn_irq_info = new_irq_info;
83821d3f MM	182	if (new_irq_info == NULL)
	183	return;
	184
	185	/*
	186	* Map the xio address into bus space
	187	*/
	188
	189	bus_addr = (*provider->dma_map_consistent)(pdev,
	190	new_irq_info->irq_xtalkaddr,
	191	sizeof(new_irq_info->irq_xtalkaddr),
	192	SN_DMA_MSI\|SN_DMA_ADDR_XIO);
	193
38bc0361	194	sn_msi_info[irq].pci_addr = bus_addr;
3b7d1921 EB	195	msg.address_hi = (u32)(bus_addr >> 32);
	196	msg.address_lo = (u32)(bus_addr & 0x00000000ffffffff);
	197
	198	write_msi_msg(irq, &msg);
	199	set_native_irq_info(irq, cpu_mask);
83821d3f	200	}
3b7d1921	201	#endif /* CONFIG_SMP */
83821d3f	202
3b7d1921 EB	203	static void sn_ack_msi_irq(unsigned int irq)
	204	{
	205	move_native_irq(irq);
	206	ia64_eoi();
	207	}
83821d3f	208
3b7d1921	209	static int sn_msi_retrigger_irq(unsigned int irq)
83821d3f	210	{
3b7d1921 EB	211	unsigned int vector = irq;
3b7d1921 EB	212	ia64_resend_irq(vector);
83821d3f	213
3b7d1921	214	return 1;
fd58e55f	215	}
3b7d1921 EB	216
	217	static struct irq_chip sn_msi_chip = {
	218	.name = "PCI-MSI",
	219	.mask = mask_msi_irq,
	220	.unmask = unmask_msi_irq,
	221	.ack = sn_ack_msi_irq,
	222	#ifdef CONFIG_SMP
	223	.set_affinity = sn_set_msi_irq_affinity,
	224	#endif
	225	.retrigger = sn_msi_retrigger_irq,
	226	};