[linux-2.6-block.git] / arch / powerpc / sysdev / mpc52xx_pic.c

/*
 *
 * Programmable Interrupt Controller functions for the Freescale MPC52xx.
 *
 * Copyright (C) 2006 bplan GmbH
 *
 * Based on the code from the 2.4 kernel by
 * Dale Farnsworth <dfarnsworth@mvista.com> and Kent Borg.
 *
 * Copyright (C) 2004 Sylvain Munaut <tnt@246tNt.com>
 * Copyright (C) 2003 Montavista Software, Inc
 *
 * This file is licensed under the terms of the GNU General Public License
 * version 2. This program is licensed "as is" without any warranty of any
 * kind, whether express or implied.
 *
 */

#undef DEBUG

#include <linux/stddef.h>
#include <linux/init.h>
#include <linux/sched.h>
#include <linux/signal.h>
#include <linux/stddef.h>
#include <linux/delay.h>
#include <linux/irq.h>
#include <linux/hardirq.h>

#include <asm/io.h>
#include <asm/processor.h>
#include <asm/system.h>
#include <asm/irq.h>
#include <asm/prom.h>
#include <asm/mpc52xx.h>

/*
 *
*/

static struct mpc52xx_intr __iomem *intr;
static struct mpc52xx_sdma __iomem *sdma;
static struct irq_host *mpc52xx_irqhost = NULL;

static unsigned char mpc52xx_map_senses[4] = {
	IRQ_TYPE_LEVEL_HIGH,
	IRQ_TYPE_EDGE_RISING,
	IRQ_TYPE_EDGE_FALLING,
	IRQ_TYPE_LEVEL_LOW,
};

/*
 *
*/

static inline void io_be_setbit(u32 __iomem * addr, int bitno)
{
	out_be32(addr, in_be32(addr) | (1 << bitno));
}

static inline void io_be_clrbit(u32 __iomem * addr, int bitno)
{
	out_be32(addr, in_be32(addr) & ~(1 << bitno));
}

/*
 * IRQ[0-3] interrupt irq_chip
*/

static void mpc52xx_extirq_mask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_clrbit(&intr->ctrl, 11 - l2irq);
}

static void mpc52xx_extirq_unmask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_setbit(&intr->ctrl, 11 - l2irq);
}

static void mpc52xx_extirq_ack(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_setbit(&intr->ctrl, 27 - l2irq);
}

static struct irq_chip mpc52xx_extirq_irqchip = {
	.typename = " MPC52xx IRQ[0-3] ",
	.mask = mpc52xx_extirq_mask,
	.unmask = mpc52xx_extirq_unmask,
	.ack = mpc52xx_extirq_ack,
};

/*
 * Main interrupt irq_chip
*/

static void mpc52xx_main_mask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_setbit(&intr->main_mask, 15 - l2irq);
}

static void mpc52xx_main_unmask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_clrbit(&intr->main_mask, 15 - l2irq);
}

static struct irq_chip mpc52xx_main_irqchip = {
	.typename = "MPC52xx Main",
	.mask = mpc52xx_main_mask,
	.mask_ack = mpc52xx_main_mask,
	.unmask = mpc52xx_main_unmask,
};

/*
 * Peripherals interrupt irq_chip
*/

static void mpc52xx_periph_mask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_setbit(&intr->per_mask, 31 - l2irq);
}

static void mpc52xx_periph_unmask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_clrbit(&intr->per_mask, 31 - l2irq);
}

static struct irq_chip mpc52xx_periph_irqchip = {
	.typename = "MPC52xx Peripherals",
	.mask = mpc52xx_periph_mask,
	.mask_ack = mpc52xx_periph_mask,
	.unmask = mpc52xx_periph_unmask,
};

/*
 * SDMA interrupt irq_chip
*/

static void mpc52xx_sdma_mask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_setbit(&sdma->IntMask, l2irq);
}

static void mpc52xx_sdma_unmask(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	io_be_clrbit(&sdma->IntMask, l2irq);
}

static void mpc52xx_sdma_ack(unsigned int virq)
{
	int irq;
	int l2irq;

	irq = irq_map[virq].hwirq;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);

	out_be32(&sdma->IntPend, 1 << l2irq);
}

static struct irq_chip mpc52xx_sdma_irqchip = {
	.typename = "MPC52xx SDMA",
	.mask = mpc52xx_sdma_mask,
	.unmask = mpc52xx_sdma_unmask,
	.ack = mpc52xx_sdma_ack,
};

/*
 * irq_host
*/

static int mpc52xx_irqhost_match(struct irq_host *h, struct device_node *node)
{
	pr_debug("%s: node=%p\n", __func__, node);
	return mpc52xx_irqhost->host_data == node;
}

static int mpc52xx_irqhost_xlate(struct irq_host *h, struct device_node *ct,
				 u32 * intspec, unsigned int intsize,
				 irq_hw_number_t * out_hwirq,
				 unsigned int *out_flags)
{
	int intrvect_l1;
	int intrvect_l2;
	int intrvect_type;
	int intrvect_linux;

	if (intsize != 3)
		return -1;

	intrvect_l1 = (int)intspec[0];
	intrvect_l2 = (int)intspec[1];
	intrvect_type = (int)intspec[2];

	intrvect_linux =
	    (intrvect_l1 << MPC52xx_IRQ_L1_OFFSET) & MPC52xx_IRQ_L1_MASK;
	intrvect_linux |=
	    (intrvect_l2 << MPC52xx_IRQ_L2_OFFSET) & MPC52xx_IRQ_L2_MASK;

	pr_debug("return %x, l1=%d, l2=%d\n", intrvect_linux, intrvect_l1,
		 intrvect_l2);

	*out_hwirq = intrvect_linux;
	*out_flags = mpc52xx_map_senses[intrvect_type];

	return 0;
}

/*
 * this function retrieves the correct IRQ type out
 * of the MPC regs
 * Only externals IRQs needs this
*/
static int mpc52xx_irqx_gettype(int irq)
{
	int type;
	u32 ctrl_reg;

	ctrl_reg = in_be32(&intr->ctrl);
	type = (ctrl_reg >> (22 - irq * 2)) & 0x3;

	return mpc52xx_map_senses[type];
}

static int mpc52xx_irqhost_map(struct irq_host *h, unsigned int virq,
			       irq_hw_number_t irq)
{
	int l1irq;
	int l2irq;
	struct irq_chip *good_irqchip;
	void *good_handle;
	int type;

	l1irq = (irq & MPC52xx_IRQ_L1_MASK) >> MPC52xx_IRQ_L1_OFFSET;
	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;

	/*
	 * Most of ours IRQs will be level low
	 * Only external IRQs on some platform may be others
	 */
	type = IRQ_TYPE_LEVEL_LOW;

	switch (l1irq) {
	case MPC52xx_IRQ_L1_CRIT:
		pr_debug("%s: Critical. l2=%x\n", __func__, l2irq);

		BUG_ON(l2irq != 0);

		type = mpc52xx_irqx_gettype(l2irq);
		good_irqchip = &mpc52xx_extirq_irqchip;
		break;

	case MPC52xx_IRQ_L1_MAIN:
		pr_debug("%s: Main IRQ[1-3] l2=%x\n", __func__, l2irq);

		if ((l2irq >= 1) && (l2irq <= 3)) {
			type = mpc52xx_irqx_gettype(l2irq);
			good_irqchip = &mpc52xx_extirq_irqchip;
		} else {
			good_irqchip = &mpc52xx_main_irqchip;
		}
		break;

	case MPC52xx_IRQ_L1_PERP:
		pr_debug("%s: Peripherals. l2=%x\n", __func__, l2irq);
		good_irqchip = &mpc52xx_periph_irqchip;
		break;

	case MPC52xx_IRQ_L1_SDMA:
		pr_debug("%s: SDMA. l2=%x\n", __func__, l2irq);
		good_irqchip = &mpc52xx_sdma_irqchip;
		break;

	default:
		pr_debug("%s: Error, unknown L1 IRQ (0x%x)\n", __func__, l1irq);
		printk(KERN_ERR "Unknow IRQ!\n");
		return -EINVAL;
	}

	switch (type) {
	case IRQ_TYPE_EDGE_FALLING:
	case IRQ_TYPE_EDGE_RISING:
		good_handle = handle_edge_irq;
		break;
	default:
		good_handle = handle_level_irq;
	}

	set_irq_chip_and_handler(virq, good_irqchip, good_handle);

	pr_debug("%s: virq=%x, hw=%x. type=%x\n", __func__, virq,
		 (int)irq, type);

	return 0;
}

static struct irq_host_ops mpc52xx_irqhost_ops = {
	.match = mpc52xx_irqhost_match,
	.xlate = mpc52xx_irqhost_xlate,
	.map = mpc52xx_irqhost_map,
};

/*
 * init (public)
*/

void __init mpc52xx_init_irq(void)
{
	struct device_node *picnode = NULL;
	int picnode_regsize;
	u32 picnode_regoffset;

	struct device_node *sdmanode = NULL;
	int sdmanode_regsize;
	u32 sdmanode_regoffset;

	u64 size64;
	int flags;

	u32 intr_ctrl;

	picnode = of_find_compatible_node(NULL, "interrupt-controller",
						"mpc5200-pic");
	if (picnode == NULL) {
		printk(KERN_ERR "MPC52xx PIC: "
			"Unable to find the interrupt controller "
			"in the OpenFirmware device tree\n");
		goto end;
	}

	sdmanode = of_find_compatible_node(NULL, "dma-controller",
						 "mpc5200-bestcomm");
	if (sdmanode == NULL) {
		printk(KERN_ERR "MPC52xx PIC"
			"Unable to find the Bestcomm DMA controller device "
			"in the OpenFirmware device tree\n");
		goto end;
	}

	/* Retrieve PIC ressources */
	picnode_regoffset = (u32) of_get_address(picnode, 0, &size64, &flags);
	if (picnode_regoffset == 0) {
		printk(KERN_ERR "MPC52xx PIC"
			"Unable to get the interrupt controller address\n");
		goto end;
	}

	picnode_regoffset =
		of_translate_address(picnode, (u32 *) picnode_regoffset);
	picnode_regsize = (int)size64;

	/* Retrieve SDMA ressources */
	sdmanode_regoffset = (u32) of_get_address(sdmanode, 0, &size64, &flags);
	if (sdmanode_regoffset == 0) {
		printk(KERN_ERR "MPC52xx PIC: "
			"Unable to get the Bestcomm DMA controller address\n");
		goto end;
	}

	sdmanode_regoffset =
	    of_translate_address(sdmanode, (u32 *) sdmanode_regoffset);
	sdmanode_regsize = (int)size64;

	/* Remap the necessary zones */
	intr = ioremap(picnode_regoffset, picnode_regsize);
	if (intr == NULL) {
		printk(KERN_ERR "MPC52xx PIC: "
			"Unable to ioremap interrupt controller registers!\n");
		goto end;
	}

	sdma = ioremap(sdmanode_regoffset, sdmanode_regsize);
	if (sdma == NULL) {
		iounmap(intr);
		printk(KERN_ERR "MPC52xx PIC: "
			"Unable to ioremap Bestcomm DMA registers!\n");
		goto end;
	}

	printk(KERN_INFO "MPC52xx PIC: MPC52xx PIC Remapped at 0x%8.8x\n",
		picnode_regoffset);
	printk(KERN_INFO "MPC52xx PIC: MPC52xx SDMA Remapped at 0x%8.8x\n",
		sdmanode_regoffset);

	/* Disable all interrupt sources. */
	out_be32(&sdma->IntPend, 0xffffffff);	/* 1 means clear pending */
	out_be32(&sdma->IntMask, 0xffffffff);	/* 1 means disabled */
	out_be32(&intr->per_mask, 0x7ffffc00);	/* 1 means disabled */
	out_be32(&intr->main_mask, 0x00010fff);	/* 1 means disabled */
	intr_ctrl = in_be32(&intr->ctrl);
	intr_ctrl &= 0x00ff0000;	/* Keeps IRQ[0-3] config */
	intr_ctrl |=	0x0f000000 |	/* clear IRQ 0-3 */
			0x00001000 |	/* MEE master external enable */
			0x00000000 |	/* 0 means disable IRQ 0-3 */
			0x00000001;	/* CEb route critical normally */
	out_be32(&intr->ctrl, intr_ctrl);

	/* Zero a bunch of the priority settings. */
	out_be32(&intr->per_pri1, 0);
	out_be32(&intr->per_pri2, 0);
	out_be32(&intr->per_pri3, 0);
	out_be32(&intr->main_pri1, 0);
	out_be32(&intr->main_pri2, 0);

	/*
	 * As last step, add an irq host to translate the real
	 * hw irq information provided by the ofw to linux virq
	 */

	mpc52xx_irqhost =
	    irq_alloc_host(IRQ_HOST_MAP_LINEAR, MPC52xx_IRQ_HIGHTESTHWIRQ,
			   &mpc52xx_irqhost_ops, -1);

	if (mpc52xx_irqhost) {
		mpc52xx_irqhost->host_data = picnode;
		printk(KERN_INFO "MPC52xx PIC is up and running!\n");
	} else {
		printk(KERN_ERR
			"MPC52xx PIC: Unable to allocate the IRQ host\n");
	}

end:
	of_node_put(picnode);
	of_node_put(sdmanode);
}

/*
 * get_irq (public)
*/
unsigned int mpc52xx_get_irq(void)
{
	u32 status;
	int irq = NO_IRQ_IGNORE;

	status = in_be32(&intr->enc_status);
	if (status & 0x00000400) {	/* critical */
		irq = (status >> 8) & 0x3;
		if (irq == 2)	/* high priority peripheral */
			goto peripheral;
		irq |=	(MPC52xx_IRQ_L1_CRIT << MPC52xx_IRQ_L1_OFFSET) &
			MPC52xx_IRQ_L1_MASK;
	} else if (status & 0x00200000) {	/* main */
		irq = (status >> 16) & 0x1f;
		if (irq == 4)	/* low priority peripheral */
			goto peripheral;
		irq |=	(MPC52xx_IRQ_L1_MAIN << MPC52xx_IRQ_L1_OFFSET) &
			MPC52xx_IRQ_L1_MASK;
	} else if (status & 0x20000000) {	/* peripheral */
	      peripheral:
		irq = (status >> 24) & 0x1f;
		if (irq == 0) {	/* bestcomm */
			status = in_be32(&sdma->IntPend);
			irq = ffs(status) - 1;
			irq |=	(MPC52xx_IRQ_L1_SDMA << MPC52xx_IRQ_L1_OFFSET) &
				MPC52xx_IRQ_L1_MASK;
		} else
			irq |=	(MPC52xx_IRQ_L1_PERP << MPC52xx_IRQ_L1_OFFSET) &
				MPC52xx_IRQ_L1_MASK;
	}

	pr_debug("%s: irq=%x. virq=%d\n", __func__, irq,
		 irq_linear_revmap(mpc52xx_irqhost, irq));

	return irq_linear_revmap(mpc52xx_irqhost, irq);
}
Commit	Line	Data
0f6c95dc ND	1	/*
	2	*
	3	* Programmable Interrupt Controller functions for the Freescale MPC52xx.
	4	*
	5	* Copyright (C) 2006 bplan GmbH
	6	*
	7	* Based on the code from the 2.4 kernel by
	8	* Dale Farnsworth <dfarnsworth@mvista.com> and Kent Borg.
	9	*
	10	* Copyright (C) 2004 Sylvain Munaut <tnt@246tNt.com>
	11	* Copyright (C) 2003 Montavista Software, Inc
	12	*
	13	* This file is licensed under the terms of the GNU General Public License
	14	* version 2. This program is licensed "as is" without any warranty of any
	15	* kind, whether express or implied.
	16	*
	17	*/
	18
	19	#undef DEBUG
	20
	21	#include <linux/stddef.h>
	22	#include <linux/init.h>
	23	#include <linux/sched.h>
	24	#include <linux/signal.h>
	25	#include <linux/stddef.h>
	26	#include <linux/delay.h>
	27	#include <linux/irq.h>
	28	#include <linux/hardirq.h>
	29
	30	#include <asm/io.h>
	31	#include <asm/processor.h>
	32	#include <asm/system.h>
	33	#include <asm/irq.h>
	34	#include <asm/prom.h>
	35	#include <asm/mpc52xx.h>
	36
	37	/*
	38	*
	39	*/
	40
	41	static struct mpc52xx_intr __iomem *intr;
	42	static struct mpc52xx_sdma __iomem *sdma;
	43	static struct irq_host *mpc52xx_irqhost = NULL;
	44
	45	static unsigned char mpc52xx_map_senses[4] = {
	46	IRQ_TYPE_LEVEL_HIGH,
	47	IRQ_TYPE_EDGE_RISING,
	48	IRQ_TYPE_EDGE_FALLING,
	49	IRQ_TYPE_LEVEL_LOW,
	50	};
	51
	52	/*
	53	*
	54	*/
	55
	56	static inline void io_be_setbit(u32 __iomem * addr, int bitno)
	57	{
	58	out_be32(addr, in_be32(addr) \| (1 << bitno));
	59	}
	60
	61	static inline void io_be_clrbit(u32 __iomem * addr, int bitno)
	62	{
	63	out_be32(addr, in_be32(addr) & ~(1 << bitno));
	64	}
65
66	/*
67	* IRQ[0-3] interrupt irq_chip
68	*/
69
70	static void mpc52xx_extirq_mask(unsigned int virq)
71	{
72	int irq;
73	int l2irq;
74
75	irq = irq_map[virq].hwirq;
76	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
77
78	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
79
80	io_be_clrbit(&intr->ctrl, 11 - l2irq);
81	}
82
83	static void mpc52xx_extirq_unmask(unsigned int virq)
84	{
85	int irq;
86	int l2irq;
87
88	irq = irq_map[virq].hwirq;
89	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
90
91	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
92
93	io_be_setbit(&intr->ctrl, 11 - l2irq);
94	}
95
96	static void mpc52xx_extirq_ack(unsigned int virq)
97	{
98	int irq;
99	int l2irq;
100
101	irq = irq_map[virq].hwirq;
102	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
103
104	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
105
106	io_be_setbit(&intr->ctrl, 27 - l2irq);
107	}
108
109	static struct irq_chip mpc52xx_extirq_irqchip = {
110	.typename = " MPC52xx IRQ[0-3] ",
111	.mask = mpc52xx_extirq_mask,
112	.unmask = mpc52xx_extirq_unmask,
113	.ack = mpc52xx_extirq_ack,
114	};
115
116	/*
117	* Main interrupt irq_chip
118	*/
119
120	static void mpc52xx_main_mask(unsigned int virq)
121	{
122	int irq;
123	int l2irq;
124
125	irq = irq_map[virq].hwirq;
126	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
127
128	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
129
130	io_be_setbit(&intr->main_mask, 15 - l2irq);
131	}
132
133	static void mpc52xx_main_unmask(unsigned int virq)
134	{
135	int irq;
136	int l2irq;
137
138	irq = irq_map[virq].hwirq;
139	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
140
141	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
142
143	io_be_clrbit(&intr->main_mask, 15 - l2irq);
144	}
145
146	static struct irq_chip mpc52xx_main_irqchip = {
147	.typename = "MPC52xx Main",
148	.mask = mpc52xx_main_mask,
149	.mask_ack = mpc52xx_main_mask,
150	.unmask = mpc52xx_main_unmask,
151	};
152
153	/*
154	* Peripherals interrupt irq_chip
155	*/
156
157	static void mpc52xx_periph_mask(unsigned int virq)
158	{
159	int irq;
160	int l2irq;
161
162	irq = irq_map[virq].hwirq;
163	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
164
165	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
166
167	io_be_setbit(&intr->per_mask, 31 - l2irq);
168	}
169
170	static void mpc52xx_periph_unmask(unsigned int virq)
171	{
172	int irq;
173	int l2irq;
174
175	irq = irq_map[virq].hwirq;
176	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
177
178	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
179
180	io_be_clrbit(&intr->per_mask, 31 - l2irq);
181	}
182
183	static struct irq_chip mpc52xx_periph_irqchip = {
184	.typename = "MPC52xx Peripherals",
185	.mask = mpc52xx_periph_mask,
186	.mask_ack = mpc52xx_periph_mask,
187	.unmask = mpc52xx_periph_unmask,
188	};
189
190	/*
191	* SDMA interrupt irq_chip
192	*/
193
194	static void mpc52xx_sdma_mask(unsigned int virq)
195	{
196	int irq;
197	int l2irq;
198
199	irq = irq_map[virq].hwirq;
200	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
201
202	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
203
204	io_be_setbit(&sdma->IntMask, l2irq);
205	}
206
207	static void mpc52xx_sdma_unmask(unsigned int virq)
208	{
209	int irq;
210	int l2irq;
211
212	irq = irq_map[virq].hwirq;
213	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
214
215	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
216
217	io_be_clrbit(&sdma->IntMask, l2irq);
218	}
219
220	static void mpc52xx_sdma_ack(unsigned int virq)
221	{
222	int irq;
223	int l2irq;
224
225	irq = irq_map[virq].hwirq;
226	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
227
228	pr_debug("%s: irq=%x. l2=%d\n", __func__, irq, l2irq);
229
230	out_be32(&sdma->IntPend, 1 << l2irq);
231	}
232
233	static struct irq_chip mpc52xx_sdma_irqchip = {
234	.typename = "MPC52xx SDMA",
235	.mask = mpc52xx_sdma_mask,
236	.unmask = mpc52xx_sdma_unmask,
237	.ack = mpc52xx_sdma_ack,
238	};
239
240	/*
241	* irq_host
242	*/
243
244	static int mpc52xx_irqhost_match(struct irq_host h, struct device_node node)
245	{
246	pr_debug("%s: node=%p\n", __func__, node);
247	return mpc52xx_irqhost->host_data == node;
248	}
249
250	static int mpc52xx_irqhost_xlate(struct irq_host h, struct device_node ct,
251	u32 * intspec, unsigned int intsize,
252	irq_hw_number_t * out_hwirq,
253	unsigned int *out_flags)
254	{
255	int intrvect_l1;
256	int intrvect_l2;
257	int intrvect_type;
258	int intrvect_linux;
259
260	if (intsize != 3)
261	return -1;
262
263	intrvect_l1 = (int)intspec[0];
264	intrvect_l2 = (int)intspec[1];
265	intrvect_type = (int)intspec[2];
266
267	intrvect_linux =
268	(intrvect_l1 << MPC52xx_IRQ_L1_OFFSET) & MPC52xx_IRQ_L1_MASK;
269	intrvect_linux \|=
270	(intrvect_l2 << MPC52xx_IRQ_L2_OFFSET) & MPC52xx_IRQ_L2_MASK;
271
272	pr_debug("return %x, l1=%d, l2=%d\n", intrvect_linux, intrvect_l1,
273	intrvect_l2);
274
275	*out_hwirq = intrvect_linux;
276	*out_flags = mpc52xx_map_senses[intrvect_type];
277
278	return 0;
279	}
280
281	/*
282	* this function retrieves the correct IRQ type out
283	* of the MPC regs
284	* Only externals IRQs needs this
285	*/
286	static int mpc52xx_irqx_gettype(int irq)
287	{
288	int type;
289	u32 ctrl_reg;
290
291	ctrl_reg = in_be32(&intr->ctrl);
292	type = (ctrl_reg >> (22 - irq * 2)) & 0x3;
293
294	return mpc52xx_map_senses[type];
295	}
296
297	static int mpc52xx_irqhost_map(struct irq_host *h, unsigned int virq,
298	irq_hw_number_t irq)
299	{
300	int l1irq;
301	int l2irq;
302	struct irq_chip *good_irqchip;
303	void *good_handle;
304	int type;
305
306	l1irq = (irq & MPC52xx_IRQ_L1_MASK) >> MPC52xx_IRQ_L1_OFFSET;
307	l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
308
309	/*
310	* Most of ours IRQs will be level low
311	* Only external IRQs on some platform may be others
312	*/
313	type = IRQ_TYPE_LEVEL_LOW;
314
315	switch (l1irq) {
316	case MPC52xx_IRQ_L1_CRIT:
317	pr_debug("%s: Critical. l2=%x\n", __func__, l2irq);
318
319	BUG_ON(l2irq != 0);
320
321	type = mpc52xx_irqx_gettype(l2irq);
322	good_irqchip = &mpc52xx_extirq_irqchip;
323	break;
324
325	case MPC52xx_IRQ_L1_MAIN:
326	pr_debug("%s: Main IRQ[1-3] l2=%x\n", __func__, l2irq);
327
328	if ((l2irq >= 1) && (l2irq <= 3)) {
329	type = mpc52xx_irqx_gettype(l2irq);
330	good_irqchip = &mpc52xx_extirq_irqchip;
331	} else {
332	good_irqchip = &mpc52xx_main_irqchip;
333	}
334	break;
335
336	case MPC52xx_IRQ_L1_PERP:
337	pr_debug("%s: Peripherals. l2=%x\n", __func__, l2irq);
338	good_irqchip = &mpc52xx_periph_irqchip;
339	break;
340
341	case MPC52xx_IRQ_L1_SDMA:
342	pr_debug("%s: SDMA. l2=%x\n", __func__, l2irq);
343	good_irqchip = &mpc52xx_sdma_irqchip;
344	break;
345
346	default:
347	pr_debug("%s: Error, unknown L1 IRQ (0x%x)\n", __func__, l1irq);
348	printk(KERN_ERR "Unknow IRQ!\n");
349	return -EINVAL;
350	}
351
352	switch (type) {
353	case IRQ_TYPE_EDGE_FALLING:
354	case IRQ_TYPE_EDGE_RISING:
355	good_handle = handle_edge_irq;
356	break;
357	default:
358	good_handle = handle_level_irq;
359	}
360
361	set_irq_chip_and_handler(virq, good_irqchip, good_handle);
362
363	pr_debug("%s: virq=%x, hw=%x. type=%x\n", __func__, virq,
364	(int)irq, type);
365
366	return 0;
367	}
368
369	static struct irq_host_ops mpc52xx_irqhost_ops = {
370	.match = mpc52xx_irqhost_match,
371	.xlate = mpc52xx_irqhost_xlate,
372	.map = mpc52xx_irqhost_map,
373	};
374
375	/*
376	* init (public)
377	*/
378
379	void __init mpc52xx_init_irq(void)
380	{
381	struct device_node *picnode = NULL;
382	int picnode_regsize;
383	u32 picnode_regoffset;
384
385	struct device_node *sdmanode = NULL;
386	int sdmanode_regsize;
387	u32 sdmanode_regoffset;
388
389	u64 size64;
390	int flags;
391
392	u32 intr_ctrl;
393
394	picnode = of_find_compatible_node(NULL, "interrupt-controller",
395	"mpc5200-pic");
396	if (picnode == NULL) {
397	printk(KERN_ERR "MPC52xx PIC: "
398	"Unable to find the interrupt controller "
399	"in the OpenFirmware device tree\n");
400	goto end;
401	}
402
403	sdmanode = of_find_compatible_node(NULL, "dma-controller",
404	"mpc5200-bestcomm");
405	if (sdmanode == NULL) {
406	printk(KERN_ERR "MPC52xx PIC"
407	"Unable to find the Bestcomm DMA controller device "
408	"in the OpenFirmware device tree\n");
409	goto end;
410	}
411
412	/* Retrieve PIC ressources */
413	picnode_regoffset = (u32) of_get_address(picnode, 0, &size64, &flags);
414	if (picnode_regoffset == 0) {
415	printk(KERN_ERR "MPC52xx PIC"
416	"Unable to get the interrupt controller address\n");
417	goto end;
418	}
419
420	picnode_regoffset =
421	of_translate_address(picnode, (u32 *) picnode_regoffset);
422	picnode_regsize = (int)size64;
423
424	/* Retrieve SDMA ressources */
425	sdmanode_regoffset = (u32) of_get_address(sdmanode, 0, &size64, &flags);
426	if (sdmanode_regoffset == 0) {
427	printk(KERN_ERR "MPC52xx PIC: "
428	"Unable to get the Bestcomm DMA controller address\n");
429	goto end;
430	}
431
432	sdmanode_regoffset =
433	of_translate_address(sdmanode, (u32 *) sdmanode_regoffset);
434	sdmanode_regsize = (int)size64;
435
436	/* Remap the necessary zones */
437	intr = ioremap(picnode_regoffset, picnode_regsize);
438	if (intr == NULL) {
439	printk(KERN_ERR "MPC52xx PIC: "
440	"Unable to ioremap interrupt controller registers!\n");
441	goto end;
442	}
443
444	sdma = ioremap(sdmanode_regoffset, sdmanode_regsize);
445	if (sdma == NULL) {
446	iounmap(intr);
447	printk(KERN_ERR "MPC52xx PIC: "
448	"Unable to ioremap Bestcomm DMA registers!\n");
449	goto end;
450	}
451
452	printk(KERN_INFO "MPC52xx PIC: MPC52xx PIC Remapped at 0x%8.8x\n",
453	picnode_regoffset);
454	printk(KERN_INFO "MPC52xx PIC: MPC52xx SDMA Remapped at 0x%8.8x\n",
455	sdmanode_regoffset);
456
457	/* Disable all interrupt sources. */
458	out_be32(&sdma->IntPend, 0xffffffff); /* 1 means clear pending */
459	out_be32(&sdma->IntMask, 0xffffffff); /* 1 means disabled */
460	out_be32(&intr->per_mask, 0x7ffffc00); /* 1 means disabled */
461	out_be32(&intr->main_mask, 0x00010fff); /* 1 means disabled */
462	intr_ctrl = in_be32(&intr->ctrl);
463	intr_ctrl &= 0x00ff0000; /* Keeps IRQ[0-3] config */
464	intr_ctrl \|= 0x0f000000 \| /* clear IRQ 0-3 */
465	0x00001000 \| /* MEE master external enable */
466	0x00000000 \| /* 0 means disable IRQ 0-3 */
467	0x00000001; /* CEb route critical normally */
468	out_be32(&intr->ctrl, intr_ctrl);
469
470	/* Zero a bunch of the priority settings. */
471	out_be32(&intr->per_pri1, 0);
472	out_be32(&intr->per_pri2, 0);
473	out_be32(&intr->per_pri3, 0);
474	out_be32(&intr->main_pri1, 0);
475	out_be32(&intr->main_pri2, 0);
476
477	/*
478	* As last step, add an irq host to translate the real
479	* hw irq information provided by the ofw to linux virq
480	*/
481
482	mpc52xx_irqhost =
483	irq_alloc_host(IRQ_HOST_MAP_LINEAR, MPC52xx_IRQ_HIGHTESTHWIRQ,
484	&mpc52xx_irqhost_ops, -1);
485
486	if (mpc52xx_irqhost) {
487	mpc52xx_irqhost->host_data = picnode;
488	printk(KERN_INFO "MPC52xx PIC is up and running!\n");
489	} else {
490	printk(KERN_ERR
491	"MPC52xx PIC: Unable to allocate the IRQ host\n");
492	}
493
494	end:
495	of_node_put(picnode);
496	of_node_put(sdmanode);
497	}
498
499	/*
500	* get_irq (public)
501	*/
502	unsigned int mpc52xx_get_irq(void)
503	{
504	u32 status;
505	int irq = NO_IRQ_IGNORE;
506
507	status = in_be32(&intr->enc_status);
508	if (status & 0x00000400) { /* critical */
509	irq = (status >> 8) & 0x3;
510	if (irq == 2) /* high priority peripheral */
511	goto peripheral;
512	irq \|= (MPC52xx_IRQ_L1_CRIT << MPC52xx_IRQ_L1_OFFSET) &
513	MPC52xx_IRQ_L1_MASK;
514	} else if (status & 0x00200000) { /* main */
515	irq = (status >> 16) & 0x1f;
516	if (irq == 4) /* low priority peripheral */
517	goto peripheral;
518	irq \|= (MPC52xx_IRQ_L1_MAIN << MPC52xx_IRQ_L1_OFFSET) &
519	MPC52xx_IRQ_L1_MASK;
520	} else if (status & 0x20000000) { /* peripheral */
521	peripheral:
522	irq = (status >> 24) & 0x1f;
523	if (irq == 0) { /* bestcomm */
524	status = in_be32(&sdma->IntPend);
525	irq = ffs(status) - 1;
526	irq \|= (MPC52xx_IRQ_L1_SDMA << MPC52xx_IRQ_L1_OFFSET) &
527	MPC52xx_IRQ_L1_MASK;
528	} else
529	irq \|= (MPC52xx_IRQ_L1_PERP << MPC52xx_IRQ_L1_OFFSET) &
530	MPC52xx_IRQ_L1_MASK;
531	}
532
533	pr_debug("%s: irq=%x. virq=%d\n", __func__, irq,
534	irq_linear_revmap(mpc52xx_irqhost, irq));
535
536	return irq_linear_revmap(mpc52xx_irqhost, irq);
537	}
538