[net-next-2.6.git] / arch / powerpc / platforms / cell / interrupt.c

/*
 * Cell Internal Interrupt Controller
 *
 * Copyright (C) 2006 Benjamin Herrenschmidt (benh@kernel.crashing.org)
 *                    IBM, Corp.
 *
 * (C) Copyright IBM Deutschland Entwicklung GmbH 2005
 *
 * Author: Arnd Bergmann <arndb@de.ibm.com>
 *
 * 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, or (at your option)
 * any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 * TODO:
 * - Fix various assumptions related to HW CPU numbers vs. linux CPU numbers
 *   vs node numbers in the setup code
 * - Implement proper handling of maxcpus=1/2 (that is, routing of irqs from
 *   a non-active node to the active node)
 */

#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/module.h>
#include <linux/percpu.h>
#include <linux/types.h>
#include <linux/ioport.h>
#include <linux/kernel_stat.h>

#include <asm/io.h>
#include <asm/pgtable.h>
#include <asm/prom.h>
#include <asm/ptrace.h>
#include <asm/machdep.h>
#include <asm/cell-regs.h>

#include "interrupt.h"

struct iic {
	struct cbe_iic_thread_regs __iomem *regs;
	u8 target_id;
	u8 eoi_stack[16];
	int eoi_ptr;
	struct device_node *node;
};

static DEFINE_PER_CPU(struct iic, cpu_iic);
#define IIC_NODE_COUNT	2
static struct irq_host *iic_host;

/* Convert between "pending" bits and hw irq number */
static irq_hw_number_t iic_pending_to_hwnum(struct cbe_iic_pending_bits bits)
{
	unsigned char unit = bits.source & 0xf;
	unsigned char node = bits.source >> 4;
	unsigned char class = bits.class & 3;

	/* Decode IPIs */
	if (bits.flags & CBE_IIC_IRQ_IPI)
		return IIC_IRQ_TYPE_IPI | (bits.prio >> 4);
	else
		return (node << IIC_IRQ_NODE_SHIFT) | (class << 4) | unit;
}

static void iic_mask(unsigned int irq)
{
}

static void iic_unmask(unsigned int irq)
{
}

static void iic_eoi(unsigned int irq)
{
	struct iic *iic = &__get_cpu_var(cpu_iic);
	out_be64(&iic->regs->prio, iic->eoi_stack[--iic->eoi_ptr]);
	BUG_ON(iic->eoi_ptr < 0);
}

static struct irq_chip iic_chip = {
	.name = " CELL-IIC ",
	.mask = iic_mask,
	.unmask = iic_unmask,
	.eoi = iic_eoi,
};


static void iic_ioexc_eoi(unsigned int irq)
{
}

static void iic_ioexc_cascade(unsigned int irq, struct irq_desc *desc)
{
	struct cbe_iic_regs __iomem *node_iic = (void __iomem *)desc->handler_data;
	unsigned int base = (irq & 0xffffff00) | IIC_IRQ_TYPE_IOEXC;
	unsigned long bits, ack;
	int cascade;

	for (;;) {
		bits = in_be64(&node_iic->iic_is);
		if (bits == 0)
			break;
		/* pre-ack edge interrupts */
		ack = bits & IIC_ISR_EDGE_MASK;
		if (ack)
			out_be64(&node_iic->iic_is, ack);
		/* handle them */
		for (cascade = 63; cascade >= 0; cascade--)
			if (bits & (0x8000000000000000UL >> cascade)) {
				unsigned int cirq =
					irq_linear_revmap(iic_host,
							  base | cascade);
				if (cirq != NO_IRQ)
					generic_handle_irq(cirq);
			}
		/* post-ack level interrupts */
		ack = bits & ~IIC_ISR_EDGE_MASK;
		if (ack)
			out_be64(&node_iic->iic_is, ack);
	}
	desc->chip->eoi(irq);
}


static struct irq_chip iic_ioexc_chip = {
	.name = " CELL-IOEX",
	.mask = iic_mask,
	.unmask = iic_unmask,
	.eoi = iic_ioexc_eoi,
};

/* Get an IRQ number from the pending state register of the IIC */
static unsigned int iic_get_irq(void)
{
	struct cbe_iic_pending_bits pending;
	struct iic *iic;
	unsigned int virq;

	iic = &__get_cpu_var(cpu_iic);
	*(unsigned long *) &pending =
		in_be64((u64 __iomem *) &iic->regs->pending_destr);
	if (!(pending.flags & CBE_IIC_IRQ_VALID))
		return NO_IRQ;
	virq = irq_linear_revmap(iic_host, iic_pending_to_hwnum(pending));
	if (virq == NO_IRQ)
		return NO_IRQ;
	iic->eoi_stack[++iic->eoi_ptr] = pending.prio;
	BUG_ON(iic->eoi_ptr > 15);
	return virq;
}

void iic_setup_cpu(void)
{
	out_be64(&__get_cpu_var(cpu_iic).regs->prio, 0xff);
}

u8 iic_get_target_id(int cpu)
{
	return per_cpu(cpu_iic, cpu).target_id;
}

EXPORT_SYMBOL_GPL(iic_get_target_id);

#ifdef CONFIG_SMP

/* Use the highest interrupt priorities for IPI */
static inline int iic_ipi_to_irq(int ipi)
{
	return IIC_IRQ_TYPE_IPI + 0xf - ipi;
}

void iic_cause_IPI(int cpu, int mesg)
{
	out_be64(&per_cpu(cpu_iic, cpu).regs->generate, (0xf - mesg) << 4);
}

struct irq_host *iic_get_irq_host(int node)
{
	return iic_host;
}
EXPORT_SYMBOL_GPL(iic_get_irq_host);

static irqreturn_t iic_ipi_action(int irq, void *dev_id)
{
	int ipi = (int)(long)dev_id;

	smp_message_recv(ipi);

	return IRQ_HANDLED;
}
static void iic_request_ipi(int ipi, const char *name)
{
	int virq;

	virq = irq_create_mapping(iic_host, iic_ipi_to_irq(ipi));
	if (virq == NO_IRQ) {
		printk(KERN_ERR
		       "iic: failed to map IPI %s\n", name);
		return;
	}
	if (request_irq(virq, iic_ipi_action, IRQF_DISABLED, name,
			(void *)(long)ipi))
		printk(KERN_ERR
		       "iic: failed to request IPI %s\n", name);
}

void iic_request_IPIs(void)
{
	iic_request_ipi(PPC_MSG_CALL_FUNCTION, "IPI-call");
	iic_request_ipi(PPC_MSG_RESCHEDULE, "IPI-resched");
	iic_request_ipi(PPC_MSG_CALL_FUNC_SINGLE, "IPI-call-single");
#ifdef CONFIG_DEBUGGER
	iic_request_ipi(PPC_MSG_DEBUGGER_BREAK, "IPI-debug");
#endif /* CONFIG_DEBUGGER */
}

#endif /* CONFIG_SMP */


static int iic_host_match(struct irq_host *h, struct device_node *node)
{
	return of_device_is_compatible(node,
				    "IBM,CBEA-Internal-Interrupt-Controller");
}

extern int noirqdebug;

static void handle_iic_irq(unsigned int irq, struct irq_desc *desc)
{
	raw_spin_lock(&desc->lock);

	desc->status &= ~(IRQ_REPLAY | IRQ_WAITING);

	/*
	 * If we're currently running this IRQ, or its disabled,
	 * we shouldn't process the IRQ. Mark it pending, handle
	 * the necessary masking and go out
	 */
	if (unlikely((desc->status & (IRQ_INPROGRESS | IRQ_DISABLED)) ||
		    !desc->action)) {
		desc->status |= IRQ_PENDING;
		goto out_eoi;
	}

	kstat_incr_irqs_this_cpu(irq, desc);

	/* Mark the IRQ currently in progress.*/
	desc->status |= IRQ_INPROGRESS;

	do {
		struct irqaction *action = desc->action;
		irqreturn_t action_ret;

		if (unlikely(!action))
			goto out_eoi;

		desc->status &= ~IRQ_PENDING;
		raw_spin_unlock(&desc->lock);
		action_ret = handle_IRQ_event(irq, action);
		if (!noirqdebug)
			note_interrupt(irq, desc, action_ret);
		raw_spin_lock(&desc->lock);

	} while ((desc->status & (IRQ_PENDING | IRQ_DISABLED)) == IRQ_PENDING);

	desc->status &= ~IRQ_INPROGRESS;
out_eoi:
	desc->chip->eoi(irq);
	raw_spin_unlock(&desc->lock);
}

static int iic_host_map(struct irq_host *h, unsigned int virq,
			irq_hw_number_t hw)
{
	switch (hw & IIC_IRQ_TYPE_MASK) {
	case IIC_IRQ_TYPE_IPI:
		set_irq_chip_and_handler(virq, &iic_chip, handle_percpu_irq);
		break;
	case IIC_IRQ_TYPE_IOEXC:
		set_irq_chip_and_handler(virq, &iic_ioexc_chip,
					 handle_iic_irq);
		break;
	default:
		set_irq_chip_and_handler(virq, &iic_chip, handle_iic_irq);
	}
	return 0;
}

static int iic_host_xlate(struct irq_host *h, struct device_node *ct,
			   const u32 *intspec, unsigned int intsize,
			   irq_hw_number_t *out_hwirq, unsigned int *out_flags)

{
	unsigned int node, ext, unit, class;
	const u32 *val;

	if (!of_device_is_compatible(ct,
				     "IBM,CBEA-Internal-Interrupt-Controller"))
		return -ENODEV;
	if (intsize != 1)
		return -ENODEV;
	val = of_get_property(ct, "#interrupt-cells", NULL);
	if (val == NULL || *val != 1)
		return -ENODEV;

	node = intspec[0] >> 24;
	ext = (intspec[0] >> 16) & 0xff;
	class = (intspec[0] >> 8) & 0xff;
	unit = intspec[0] & 0xff;

	/* Check if node is in supported range */
	if (node > 1)
		return -EINVAL;

	/* Build up interrupt number, special case for IO exceptions */
	*out_hwirq = (node << IIC_IRQ_NODE_SHIFT);
	if (unit == IIC_UNIT_IIC && class == 1)
		*out_hwirq |= IIC_IRQ_TYPE_IOEXC | ext;
	else
		*out_hwirq |= IIC_IRQ_TYPE_NORMAL |
			(class << IIC_IRQ_CLASS_SHIFT) | unit;

	/* Dummy flags, ignored by iic code */
	*out_flags = IRQ_TYPE_EDGE_RISING;

	return 0;
}

static struct irq_host_ops iic_host_ops = {
	.match = iic_host_match,
	.map = iic_host_map,
	.xlate = iic_host_xlate,
};

static void __init init_one_iic(unsigned int hw_cpu, unsigned long addr,
				struct device_node *node)
{
	/* XXX FIXME: should locate the linux CPU number from the HW cpu
	 * number properly. We are lucky for now
	 */
	struct iic *iic = &per_cpu(cpu_iic, hw_cpu);

	iic->regs = ioremap(addr, sizeof(struct cbe_iic_thread_regs));
	BUG_ON(iic->regs == NULL);

	iic->target_id = ((hw_cpu & 2) << 3) | ((hw_cpu & 1) ? 0xf : 0xe);
	iic->eoi_stack[0] = 0xff;
	iic->node = of_node_get(node);
	out_be64(&iic->regs->prio, 0);

	printk(KERN_INFO "IIC for CPU %d target id 0x%x : %s\n",
	       hw_cpu, iic->target_id, node->full_name);
}

static int __init setup_iic(void)
{
	struct device_node *dn;
	struct resource r0, r1;
	unsigned int node, cascade, found = 0;
	struct cbe_iic_regs __iomem *node_iic;
	const u32 *np;

	for (dn = NULL;
	     (dn = of_find_node_by_name(dn,"interrupt-controller")) != NULL;) {
		if (!of_device_is_compatible(dn,
				     "IBM,CBEA-Internal-Interrupt-Controller"))
			continue;
		np = of_get_property(dn, "ibm,interrupt-server-ranges", NULL);
		if (np == NULL) {
			printk(KERN_WARNING "IIC: CPU association not found\n");
			of_node_put(dn);
			return -ENODEV;
		}
		if (of_address_to_resource(dn, 0, &r0) ||
		    of_address_to_resource(dn, 1, &r1)) {
			printk(KERN_WARNING "IIC: Can't resolve addresses\n");
			of_node_put(dn);
			return -ENODEV;
		}
		found++;
		init_one_iic(np[0], r0.start, dn);
		init_one_iic(np[1], r1.start, dn);

		/* Setup cascade for IO exceptions. XXX cleanup tricks to get
		 * node vs CPU etc...
		 * Note that we configure the IIC_IRR here with a hard coded
		 * priority of 1. We might want to improve that later.
		 */
		node = np[0] >> 1;
		node_iic = cbe_get_cpu_iic_regs(np[0]);
		cascade = node << IIC_IRQ_NODE_SHIFT;
		cascade |= 1 << IIC_IRQ_CLASS_SHIFT;
		cascade |= IIC_UNIT_IIC;
		cascade = irq_create_mapping(iic_host, cascade);
		if (cascade == NO_IRQ)
			continue;
		/*
		 * irq_data is a generic pointer that gets passed back
		 * to us later, so the forced cast is fine.
		 */
		set_irq_data(cascade, (void __force *)node_iic);
		set_irq_chained_handler(cascade , iic_ioexc_cascade);
		out_be64(&node_iic->iic_ir,
			 (1 << 12)		/* priority */ |
			 (node << 4)		/* dest node */ |
			 IIC_UNIT_THREAD_0	/* route them to thread 0 */);
		/* Flush pending (make sure it triggers if there is
		 * anything pending
		 */
		out_be64(&node_iic->iic_is, 0xfffffffffffffffful);
	}

	if (found)
		return 0;
	else
		return -ENODEV;
}

void __init iic_init_IRQ(void)
{
	/* Setup an irq host data structure */
	iic_host = irq_alloc_host(NULL, IRQ_HOST_MAP_LINEAR, IIC_SOURCE_COUNT,
				  &iic_host_ops, IIC_IRQ_INVALID);
	BUG_ON(iic_host == NULL);
	irq_set_default_host(iic_host);

	/* Discover and initialize iics */
	if (setup_iic() < 0)
		panic("IIC: Failed to initialize !\n");

	/* Set master interrupt handling function */
	ppc_md.get_irq = iic_get_irq;

	/* Enable on current CPU */
	iic_setup_cpu();
}

void iic_set_interrupt_routing(int cpu, int thread, int priority)
{
	struct cbe_iic_regs __iomem *iic_regs = cbe_get_cpu_iic_regs(cpu);
	u64 iic_ir = 0;
	int node = cpu >> 1;

	/* Set which node and thread will handle the next interrupt */
	iic_ir |= CBE_IIC_IR_PRIO(priority) |
		  CBE_IIC_IR_DEST_NODE(node);
	if (thread == 0)
		iic_ir |= CBE_IIC_IR_DEST_UNIT(CBE_IIC_IR_PT_0);
	else
		iic_ir |= CBE_IIC_IR_DEST_UNIT(CBE_IIC_IR_PT_1);
	out_be64(&iic_regs->iic_ir, iic_ir);
}
Commit	Line	Data
cebf589c	1	/*
f3f66f59	2	* Cell Internal Interrupt Controller
cebf589c	3	*
0ebfff14 BH	4	* Copyright (C) 2006 Benjamin Herrenschmidt (benh@kernel.crashing.org)
	5	* IBM, Corp.
	6	*
cebf589c AB	7	* (C) Copyright IBM Deutschland Entwicklung GmbH 2005
	8	*
	9	* Author: Arnd Bergmann <arndb@de.ibm.com>
	10	*
	11	* This program is free software; you can redistribute it and/or modify
	12	* it under the terms of the GNU General Public License as published by
	13	* the Free Software Foundation; either version 2, or (at your option)
	14	* any later version.
	15	*
	16	* This program is distributed in the hope that it will be useful,
	17	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	18	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	19	* GNU General Public License for more details.
	20	*
	21	* You should have received a copy of the GNU General Public License
	22	* along with this program; if not, write to the Free Software
	23	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
2e194583 BH	24	*
	25	* TODO:
	26	* - Fix various assumptions related to HW CPU numbers vs. linux CPU numbers
	27	* vs node numbers in the setup code
	28	* - Implement proper handling of maxcpus=1/2 (that is, routing of irqs from
	29	* a non-active node to the active node)
cebf589c AB	30	*/
cebf589c AB	31
cebf589c AB	32	#include <linux/interrupt.h>
cebf589c AB	33	#include <linux/irq.h>
2fb9d206	34	#include <linux/module.h>
cebf589c AB	35	#include <linux/percpu.h>
cebf589c AB	36	#include <linux/types.h>
0ebfff14	37	#include <linux/ioport.h>
5711fe90	38	#include <linux/kernel_stat.h>
cebf589c AB	39
	40	#include <asm/io.h>
	41	#include <asm/pgtable.h>
	42	#include <asm/prom.h>
	43	#include <asm/ptrace.h>
0ebfff14	44	#include <asm/machdep.h>
eef686a0	45	#include <asm/cell-regs.h>
cebf589c	46
f3f66f59	47	#include "interrupt.h"
cebf589c AB	48
cebf589c AB	49	struct iic {
acf7d768	50	struct cbe_iic_thread_regs __iomem *regs;
2fb9d206	51	u8 target_id;
b9e5b4e6 BH	52	u8 eoi_stack[16];
b9e5b4e6 BH	53	int eoi_ptr;
2e194583	54	struct device_node *node;
cebf589c AB	55	};
cebf589c AB	56
6b7487fc	57	static DEFINE_PER_CPU(struct iic, cpu_iic);
0ebfff14	58	#define IIC_NODE_COUNT 2
2e194583	59	static struct irq_host *iic_host;
0ebfff14 BH	60
	61	/* Convert between "pending" bits and hw irq number */
	62	static irq_hw_number_t iic_pending_to_hwnum(struct cbe_iic_pending_bits bits)
	63	{
	64	unsigned char unit = bits.source & 0xf;
2e194583 BH	65	unsigned char node = bits.source >> 4;
2e194583 BH	66	unsigned char class = bits.class & 3;
0ebfff14	67
2e194583	68	/* Decode IPIs */
0ebfff14	69	if (bits.flags & CBE_IIC_IRQ_IPI)
2e194583	70	return IIC_IRQ_TYPE_IPI \| (bits.prio >> 4);
0ebfff14	71	else
2e194583	72	return (node << IIC_IRQ_NODE_SHIFT) \| (class << 4) \| unit;
0ebfff14	73	}
cebf589c	74
b9e5b4e6	75	static void iic_mask(unsigned int irq)
cebf589c	76	{
cebf589c AB	77	}
cebf589c AB	78
b9e5b4e6	79	static void iic_unmask(unsigned int irq)
cebf589c AB	80	{
	81	}
	82
b9e5b4e6	83	static void iic_eoi(unsigned int irq)
cebf589c	84	{
6b7487fc	85	struct iic *iic = &__get_cpu_var(cpu_iic);
b9e5b4e6 BH	86	out_be64(&iic->regs->prio, iic->eoi_stack[--iic->eoi_ptr]);
b9e5b4e6 BH	87	BUG_ON(iic->eoi_ptr < 0);
cebf589c AB	88	}
cebf589c AB	89
b9e5b4e6	90	static struct irq_chip iic_chip = {
b27df672	91	.name = " CELL-IIC ",
b9e5b4e6 BH	92	.mask = iic_mask,
	93	.unmask = iic_unmask,
	94	.eoi = iic_eoi,
cebf589c AB	95	};
cebf589c AB	96
2e194583 BH	97
	98	static void iic_ioexc_eoi(unsigned int irq)
	99	{
	100	}
	101
35a84c2f	102	static void iic_ioexc_cascade(unsigned int irq, struct irq_desc *desc)
2e194583	103	{
43b4f406	104	struct cbe_iic_regs __iomem node_iic = (void __iomem )desc->handler_data;
2e194583 BH	105	unsigned int base = (irq & 0xffffff00) \| IIC_IRQ_TYPE_IOEXC;
	106	unsigned long bits, ack;
	107	int cascade;
	108
	109	for (;;) {
	110	bits = in_be64(&node_iic->iic_is);
	111	if (bits == 0)
	112	break;
	113	/* pre-ack edge interrupts */
	114	ack = bits & IIC_ISR_EDGE_MASK;
	115	if (ack)
	116	out_be64(&node_iic->iic_is, ack);
	117	/* handle them */
	118	for (cascade = 63; cascade >= 0; cascade--)
	119	if (bits & (0x8000000000000000UL >> cascade)) {
	120	unsigned int cirq =
	121	irq_linear_revmap(iic_host,
	122	base \| cascade);
	123	if (cirq != NO_IRQ)
49f19ce4	124	generic_handle_irq(cirq);
2e194583 BH	125	}
	126	/* post-ack level interrupts */
	127	ack = bits & ~IIC_ISR_EDGE_MASK;
	128	if (ack)
	129	out_be64(&node_iic->iic_is, ack);
	130	}
	131	desc->chip->eoi(irq);
	132	}
	133
	134
	135	static struct irq_chip iic_ioexc_chip = {
b27df672	136	.name = " CELL-IOEX",
2e194583 BH	137	.mask = iic_mask,
	138	.unmask = iic_unmask,
	139	.eoi = iic_ioexc_eoi,
	140	};
	141
cebf589c	142	/* Get an IRQ number from the pending state register of the IIC */
35a84c2f	143	static unsigned int iic_get_irq(void)
d0e57c68	144	{
9e6ee340 GL	145	struct cbe_iic_pending_bits pending;
9e6ee340 GL	146	struct iic *iic;
2e194583	147	unsigned int virq;
9e6ee340	148
6b7487fc	149	iic = &__get_cpu_var(cpu_iic);
9e6ee340	150	(unsigned long ) &pending =
b36ac9e8	151	in_be64((u64 __iomem *) &iic->regs->pending_destr);
2e194583 BH	152	if (!(pending.flags & CBE_IIC_IRQ_VALID))
	153	return NO_IRQ;
	154	virq = irq_linear_revmap(iic_host, iic_pending_to_hwnum(pending));
	155	if (virq == NO_IRQ)
	156	return NO_IRQ;
9e6ee340 GL	157	iic->eoi_stack[++iic->eoi_ptr] = pending.prio;
9e6ee340 GL	158	BUG_ON(iic->eoi_ptr > 15);
2e194583	159	return virq;
cebf589c AB	160	}
cebf589c AB	161
4bfac368 OJ	162	void iic_setup_cpu(void)
4bfac368 OJ	163	{
6b7487fc	164	out_be64(&__get_cpu_var(cpu_iic).regs->prio, 0xff);
4bfac368 OJ	165	}
	166
	167	u8 iic_get_target_id(int cpu)
	168	{
6b7487fc	169	return per_cpu(cpu_iic, cpu).target_id;
4bfac368 OJ	170	}
	171
	172	EXPORT_SYMBOL_GPL(iic_get_target_id);
	173
cebf589c	174	#ifdef CONFIG_SMP
a84195f3 AB	175
	176	/* Use the highest interrupt priorities for IPI */
	177	static inline int iic_ipi_to_irq(int ipi)
	178	{
2e194583	179	return IIC_IRQ_TYPE_IPI + 0xf - ipi;
a84195f3 AB	180	}
a84195f3 AB	181
cebf589c AB	182	void iic_cause_IPI(int cpu, int mesg)
cebf589c AB	183	{
6b7487fc	184	out_be64(&per_cpu(cpu_iic, cpu).regs->generate, (0xf - mesg) << 4);
cebf589c AB	185	}
cebf589c AB	186
0ebfff14 BH	187	struct irq_host *iic_get_irq_host(int node)
0ebfff14 BH	188	{
2e194583	189	return iic_host;
0ebfff14 BH	190	}
	191	EXPORT_SYMBOL_GPL(iic_get_irq_host);
	192
7d12e780	193	static irqreturn_t iic_ipi_action(int irq, void *dev_id)
cebf589c	194	{
0ebfff14 BH	195	int ipi = (int)(long)dev_id;
0ebfff14 BH	196
7d12e780	197	smp_message_recv(ipi);
0ebfff14	198
cebf589c AB	199	return IRQ_HANDLED;
cebf589c AB	200	}
a84195f3	201	static void iic_request_ipi(int ipi, const char *name)
cebf589c	202	{
2e194583	203	int virq;
a84195f3	204
2e194583 BH	205	virq = irq_create_mapping(iic_host, iic_ipi_to_irq(ipi));
	206	if (virq == NO_IRQ) {
	207	printk(KERN_ERR
	208	"iic: failed to map IPI %s\n", name);
	209	return;
0ebfff14	210	}
2e194583 BH	211	if (request_irq(virq, iic_ipi_action, IRQF_DISABLED, name,
	212	(void *)(long)ipi))
	213	printk(KERN_ERR
	214	"iic: failed to request IPI %s\n", name);
cebf589c AB	215	}
	216
	217	void iic_request_IPIs(void)
	218	{
a84195f3 AB	219	iic_request_ipi(PPC_MSG_CALL_FUNCTION, "IPI-call");
a84195f3 AB	220	iic_request_ipi(PPC_MSG_RESCHEDULE, "IPI-resched");
b7d7a240	221	iic_request_ipi(PPC_MSG_CALL_FUNC_SINGLE, "IPI-call-single");
cebf589c	222	#ifdef CONFIG_DEBUGGER
a84195f3	223	iic_request_ipi(PPC_MSG_DEBUGGER_BREAK, "IPI-debug");
cebf589c AB	224	#endif /* CONFIG_DEBUGGER */
cebf589c AB	225	}
0ebfff14	226
cebf589c AB	227	#endif /* CONFIG_SMP */
cebf589c AB	228
0ebfff14 BH	229
	230	static int iic_host_match(struct irq_host h, struct device_node node)
	231	{
55b61fec	232	return of_device_is_compatible(node,
2e194583	233	"IBM,CBEA-Internal-Interrupt-Controller");
0ebfff14 BH	234	}
0ebfff14 BH	235
5711fe90 JK	236	extern int noirqdebug;
	237
	238	static void handle_iic_irq(unsigned int irq, struct irq_desc *desc)
	239	{
239007b8	240	raw_spin_lock(&desc->lock);
5711fe90 JK	241
	242	desc->status &= ~(IRQ_REPLAY \| IRQ_WAITING);
	243
	244	/*
	245	* If we're currently running this IRQ, or its disabled,
	246	* we shouldn't process the IRQ. Mark it pending, handle
	247	* the necessary masking and go out
	248	*/
	249	if (unlikely((desc->status & (IRQ_INPROGRESS \| IRQ_DISABLED)) \|\|
	250	!desc->action)) {
	251	desc->status \|= IRQ_PENDING;
	252	goto out_eoi;
	253	}
	254
dee4102a	255	kstat_incr_irqs_this_cpu(irq, desc);
5711fe90 JK	256
	257	/* Mark the IRQ currently in progress.*/
	258	desc->status \|= IRQ_INPROGRESS;
	259
	260	do {
	261	struct irqaction *action = desc->action;
	262	irqreturn_t action_ret;
	263
	264	if (unlikely(!action))
	265	goto out_eoi;
	266
	267	desc->status &= ~IRQ_PENDING;
239007b8	268	raw_spin_unlock(&desc->lock);
5711fe90 JK	269	action_ret = handle_IRQ_event(irq, action);
	270	if (!noirqdebug)
	271	note_interrupt(irq, desc, action_ret);
239007b8	272	raw_spin_lock(&desc->lock);
5711fe90 JK	273
	274	} while ((desc->status & (IRQ_PENDING \| IRQ_DISABLED)) == IRQ_PENDING);
	275
	276	desc->status &= ~IRQ_INPROGRESS;
	277	out_eoi:
	278	desc->chip->eoi(irq);
239007b8	279	raw_spin_unlock(&desc->lock);
5711fe90 JK	280	}
5711fe90 JK	281
0ebfff14	282	static int iic_host_map(struct irq_host *h, unsigned int virq,
6e99e458	283	irq_hw_number_t hw)
0ebfff14	284	{
2e194583 BH	285	switch (hw & IIC_IRQ_TYPE_MASK) {
2e194583 BH	286	case IIC_IRQ_TYPE_IPI:
0ebfff14	287	set_irq_chip_and_handler(virq, &iic_chip, handle_percpu_irq);
2e194583 BH	288	break;
	289	case IIC_IRQ_TYPE_IOEXC:
	290	set_irq_chip_and_handler(virq, &iic_ioexc_chip,
5711fe90	291	handle_iic_irq);
2e194583 BH	292	break;
2e194583 BH	293	default:
5711fe90	294	set_irq_chip_and_handler(virq, &iic_chip, handle_iic_irq);
2e194583	295	}
0ebfff14 BH	296	return 0;
	297	}
	298
	299	static int iic_host_xlate(struct irq_host h, struct device_node ct,
40d50cf7	300	const u32 *intspec, unsigned int intsize,
0ebfff14 BH	301	irq_hw_number_t out_hwirq, unsigned int out_flags)
0ebfff14 BH	302
cebf589c	303	{
2e194583 BH	304	unsigned int node, ext, unit, class;
	305	const u32 *val;
	306
55b61fec	307	if (!of_device_is_compatible(ct,
2e194583 BH	308	"IBM,CBEA-Internal-Interrupt-Controller"))
	309	return -ENODEV;
	310	if (intsize != 1)
	311	return -ENODEV;
e2eb6392	312	val = of_get_property(ct, "#interrupt-cells", NULL);
2e194583 BH	313	if (val == NULL \|\| *val != 1)
	314	return -ENODEV;
	315
	316	node = intspec[0] >> 24;
	317	ext = (intspec[0] >> 16) & 0xff;
	318	class = (intspec[0] >> 8) & 0xff;
	319	unit = intspec[0] & 0xff;
	320
	321	/* Check if node is in supported range */
	322	if (node > 1)
	323	return -EINVAL;
	324
	325	/* Build up interrupt number, special case for IO exceptions */
	326	*out_hwirq = (node << IIC_IRQ_NODE_SHIFT);
	327	if (unit == IIC_UNIT_IIC && class == 1)
	328	*out_hwirq \|= IIC_IRQ_TYPE_IOEXC \| ext;
	329	else
	330	*out_hwirq \|= IIC_IRQ_TYPE_NORMAL \|
	331	(class << IIC_IRQ_CLASS_SHIFT) \| unit;
	332
	333	/* Dummy flags, ignored by iic code */
	334	*out_flags = IRQ_TYPE_EDGE_RISING;
	335
	336	return 0;
0ebfff14 BH	337	}
	338
	339	static struct irq_host_ops iic_host_ops = {
	340	.match = iic_host_match,
	341	.map = iic_host_map,
	342	.xlate = iic_host_xlate,
	343	};
	344
	345	static void __init init_one_iic(unsigned int hw_cpu, unsigned long addr,
2e194583	346	struct device_node *node)
0ebfff14 BH	347	{
	348	/* XXX FIXME: should locate the linux CPU number from the HW cpu
	349	* number properly. We are lucky for now
	350	*/
6b7487fc	351	struct iic *iic = &per_cpu(cpu_iic, hw_cpu);
cebf589c	352
0ebfff14 BH	353	iic->regs = ioremap(addr, sizeof(struct cbe_iic_thread_regs));
0ebfff14 BH	354	BUG_ON(iic->regs == NULL);
b9e5b4e6	355
0ebfff14 BH	356	iic->target_id = ((hw_cpu & 2) << 3) \| ((hw_cpu & 1) ? 0xf : 0xe);
0ebfff14 BH	357	iic->eoi_stack[0] = 0xff;
2e194583	358	iic->node = of_node_get(node);
0ebfff14 BH	359	out_be64(&iic->regs->prio, 0);
0ebfff14 BH	360
2e194583 BH	361	printk(KERN_INFO "IIC for CPU %d target id 0x%x : %s\n",
2e194583 BH	362	hw_cpu, iic->target_id, node->full_name);
0ebfff14 BH	363	}
	364
	365	static int __init setup_iic(void)
	366	{
	367	struct device_node *dn;
	368	struct resource r0, r1;
2e194583	369	unsigned int node, cascade, found = 0;
43b4f406	370	struct cbe_iic_regs __iomem *node_iic;
9e6ee340	371	const u32 *np;
0ebfff14 BH	372
	373	for (dn = NULL;
	374	(dn = of_find_node_by_name(dn,"interrupt-controller")) != NULL;) {
55b61fec	375	if (!of_device_is_compatible(dn,
0ebfff14 BH	376	"IBM,CBEA-Internal-Interrupt-Controller"))
0ebfff14 BH	377	continue;
e2eb6392	378	np = of_get_property(dn, "ibm,interrupt-server-ranges", NULL);
9e6ee340	379	if (np == NULL) {
0ebfff14 BH	380	printk(KERN_WARNING "IIC: CPU association not found\n");
	381	of_node_put(dn);
	382	return -ENODEV;
cebf589c	383	}
0ebfff14 BH	384	if (of_address_to_resource(dn, 0, &r0) \|\|
	385	of_address_to_resource(dn, 1, &r1)) {
	386	printk(KERN_WARNING "IIC: Can't resolve addresses\n");
	387	of_node_put(dn);
	388	return -ENODEV;
	389	}
2e194583 BH	390	found++;
	391	init_one_iic(np[0], r0.start, dn);
	392	init_one_iic(np[1], r1.start, dn);
	393
	394	/* Setup cascade for IO exceptions. XXX cleanup tricks to get
	395	* node vs CPU etc...
	396	* Note that we configure the IIC_IRR here with a hard coded
	397	* priority of 1. We might want to improve that later.
	398	*/
	399	node = np[0] >> 1;
	400	node_iic = cbe_get_cpu_iic_regs(np[0]);
	401	cascade = node << IIC_IRQ_NODE_SHIFT;
	402	cascade \|= 1 << IIC_IRQ_CLASS_SHIFT;
	403	cascade \|= IIC_UNIT_IIC;
	404	cascade = irq_create_mapping(iic_host, cascade);
	405	if (cascade == NO_IRQ)
	406	continue;
43b4f406 AB	407	/*
	408	* irq_data is a generic pointer that gets passed back
	409	* to us later, so the forced cast is fine.
	410	*/
	411	set_irq_data(cascade, (void __force *)node_iic);
2e194583 BH	412	set_irq_chained_handler(cascade , iic_ioexc_cascade);
	413	out_be64(&node_iic->iic_ir,
	414	(1 << 12) /* priority */ \|
	415	(node << 4) /* dest node */ \|
	416	IIC_UNIT_THREAD_0 /* route them to thread 0 */);
	417	/* Flush pending (make sure it triggers if there is
	418	* anything pending
	419	*/
	420	out_be64(&node_iic->iic_is, 0xfffffffffffffffful);
cebf589c	421	}
0ebfff14 BH	422
	423	if (found)
	424	return 0;
	425	else
	426	return -ENODEV;
cebf589c AB	427	}
cebf589c AB	428
b9e5b4e6	429	void __init iic_init_IRQ(void)
cebf589c	430	{
2e194583	431	/* Setup an irq host data structure */
52964f87	432	iic_host = irq_alloc_host(NULL, IRQ_HOST_MAP_LINEAR, IIC_SOURCE_COUNT,
2e194583 BH	433	&iic_host_ops, IIC_IRQ_INVALID);
	434	BUG_ON(iic_host == NULL);
	435	irq_set_default_host(iic_host);
	436
0ebfff14	437	/* Discover and initialize iics */
d0e57c68	438	if (setup_iic() < 0)
0ebfff14	439	panic("IIC: Failed to initialize !\n");
d0e57c68	440
0ebfff14 BH	441	/* Set master interrupt handling function */
0ebfff14 BH	442	ppc_md.get_irq = iic_get_irq;
b9e5b4e6	443
0ebfff14 BH	444	/* Enable on current CPU */
0ebfff14 BH	445	iic_setup_cpu();
cebf589c	446	}
0443bbd3 KC	447
	448	void iic_set_interrupt_routing(int cpu, int thread, int priority)
	449	{
	450	struct cbe_iic_regs __iomem *iic_regs = cbe_get_cpu_iic_regs(cpu);
	451	u64 iic_ir = 0;
	452	int node = cpu >> 1;
	453
	454	/* Set which node and thread will handle the next interrupt */
	455	iic_ir \|= CBE_IIC_IR_PRIO(priority) \|
	456	CBE_IIC_IR_DEST_NODE(node);
	457	if (thread == 0)
	458	iic_ir \|= CBE_IIC_IR_DEST_UNIT(CBE_IIC_IR_PT_0);
	459	else
	460	iic_ir \|= CBE_IIC_IR_DEST_UNIT(CBE_IIC_IR_PT_1);
	461	out_be64(&iic_regs->iic_ir, iic_ir);
	462	}