[linux-2.6-block.git] / arch / mips / kernel / irq-msc01.c

/*
 * 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.
 *
 * Copyright (c) 2004 MIPS Inc
 * Author: chris@mips.com
 *
 * Copyright (C) 2004, 06 Ralf Baechle <ralf@linux-mips.org>
 */
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/kernel_stat.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/msc01_ic.h>
#include <asm/traps.h>

static unsigned long _icctrl_msc;
#define MSC01_IC_REG_BASE	_icctrl_msc

#define MSCIC_WRITE(reg, data)	do { *(volatile u32 *)(reg) = data; } while (0)
#define MSCIC_READ(reg, data)	do { data = *(volatile u32 *)(reg); } while (0)

static unsigned int irq_base;

/* mask off an interrupt */
static inline void mask_msc_irq(struct irq_data *d)
{
	unsigned int irq = d->irq;

	if (irq < (irq_base + 32))
		MSCIC_WRITE(MSC01_IC_DISL, 1<<(irq - irq_base));
	else
		MSCIC_WRITE(MSC01_IC_DISH, 1<<(irq - irq_base - 32));
}

/* unmask an interrupt */
static inline void unmask_msc_irq(struct irq_data *d)
{
	unsigned int irq = d->irq;

	if (irq < (irq_base + 32))
		MSCIC_WRITE(MSC01_IC_ENAL, 1<<(irq - irq_base));
	else
		MSCIC_WRITE(MSC01_IC_ENAH, 1<<(irq - irq_base - 32));
}

/*
 * Masks and ACKs an IRQ
 */
static void level_mask_and_ack_msc_irq(struct irq_data *d)
{
	mask_msc_irq(d);
	if (!cpu_has_veic)
		MSCIC_WRITE(MSC01_IC_EOI, 0);
}

/*
 * Masks and ACKs an IRQ
 */
static void edge_mask_and_ack_msc_irq(struct irq_data *d)
{
	unsigned int irq = d->irq;

	mask_msc_irq(d);
	if (!cpu_has_veic)
		MSCIC_WRITE(MSC01_IC_EOI, 0);
	else {
		u32 r;
		MSCIC_READ(MSC01_IC_SUP+irq*8, r);
		MSCIC_WRITE(MSC01_IC_SUP+irq*8, r | ~MSC01_IC_SUP_EDGE_BIT);
		MSCIC_WRITE(MSC01_IC_SUP+irq*8, r);
	}
}

/*
 * Interrupt handler for interrupts coming from SOC-it.
 */
void ll_msc_irq(void)
{
	unsigned int irq;

	/* read the interrupt vector register */
	MSCIC_READ(MSC01_IC_VEC, irq);
	if (irq < 64)
		do_IRQ(irq + irq_base);
	else {
		/* Ignore spurious interrupt */
	}
}

static void msc_bind_eic_interrupt(int irq, int set)
{
	MSCIC_WRITE(MSC01_IC_RAMW,
		    (irq<<MSC01_IC_RAMW_ADDR_SHF) | (set<<MSC01_IC_RAMW_DATA_SHF));
}

static struct irq_chip msc_levelirq_type = {
	.name = "SOC-it-Level",
	.irq_ack = level_mask_and_ack_msc_irq,
	.irq_mask = mask_msc_irq,
	.irq_mask_ack = level_mask_and_ack_msc_irq,
	.irq_unmask = unmask_msc_irq,
	.irq_eoi = unmask_msc_irq,
};

static struct irq_chip msc_edgeirq_type = {
	.name = "SOC-it-Edge",
	.irq_ack = edge_mask_and_ack_msc_irq,
	.irq_mask = mask_msc_irq,
	.irq_mask_ack = edge_mask_and_ack_msc_irq,
	.irq_unmask = unmask_msc_irq,
	.irq_eoi = unmask_msc_irq,
};


void __init init_msc_irqs(unsigned long icubase, unsigned int irqbase, msc_irqmap_t *imp, int nirq)
{
	_icctrl_msc = (unsigned long) ioremap(icubase, 0x40000);

	/* Reset interrupt controller - initialises all registers to 0 */
	MSCIC_WRITE(MSC01_IC_RST, MSC01_IC_RST_RST_BIT);

	board_bind_eic_interrupt = &msc_bind_eic_interrupt;

	for (; nirq >= 0; nirq--, imp++) {
		int n = imp->im_irq;

		switch (imp->im_type) {
		case MSC01_IRQ_EDGE:
			irq_set_chip_and_handler_name(irqbase + n,
						      &msc_edgeirq_type,
						      handle_edge_irq,
						      "edge");
			if (cpu_has_veic)
				MSCIC_WRITE(MSC01_IC_SUP+n*8, MSC01_IC_SUP_EDGE_BIT);
			else
				MSCIC_WRITE(MSC01_IC_SUP+n*8, MSC01_IC_SUP_EDGE_BIT | imp->im_lvl);
			break;
		case MSC01_IRQ_LEVEL:
			irq_set_chip_and_handler_name(irqbase + n,
						      &msc_levelirq_type,
						      handle_level_irq,
						      "level");
			if (cpu_has_veic)
				MSCIC_WRITE(MSC01_IC_SUP+n*8, 0);
			else
				MSCIC_WRITE(MSC01_IC_SUP+n*8, imp->im_lvl);
		}
	}

	irq_base = irqbase;

	MSCIC_WRITE(MSC01_IC_GENA, MSC01_IC_GENA_GENA_BIT);	/* Enable interrupt generation */

}
Commit	Line	Data
1da177e4	1	/*
70342287 RB	2	* This program is free software; you can redistribute it and/or modify it
70342287 RB	3	* under the terms of the GNU General Public License as published by the
1da177e4 LT	4	* Free Software Foundation; either version 2 of the License, or (at your
1da177e4 LT	5	* option) any later version.
27f76819 RB	6	*
	7	* Copyright (c) 2004 MIPS Inc
	8	* Author: chris@mips.com
	9	*
	10	* Copyright (C) 2004, 06 Ralf Baechle <ralf@linux-mips.org>
1da177e4	11	*/
1da177e4 LT	12	#include <linux/interrupt.h>
1da177e4 LT	13	#include <linux/kernel.h>
1da177e4 LT	14	#include <linux/sched.h>
	15	#include <linux/kernel_stat.h>
	16	#include <asm/io.h>
	17	#include <asm/irq.h>
	18	#include <asm/msc01_ic.h>
411ba7fc	19	#include <asm/traps.h>
1da177e4 LT	20
	21	static unsigned long _icctrl_msc;
	22	#define MSC01_IC_REG_BASE _icctrl_msc
	23
	24	#define MSCIC_WRITE(reg, data) do { (volatile u32 )(reg) = data; } while (0)
	25	#define MSCIC_READ(reg, data) do { data = (volatile u32 )(reg); } while (0)
	26
	27	static unsigned int irq_base;
	28
	29	/* mask off an interrupt */
e15883da	30	static inline void mask_msc_irq(struct irq_data *d)
1da177e4	31	{
e15883da TG	32	unsigned int irq = d->irq;
e15883da TG	33
1da177e4 LT	34	if (irq < (irq_base + 32))
	35	MSCIC_WRITE(MSC01_IC_DISL, 1<<(irq - irq_base));
	36	else
	37	MSCIC_WRITE(MSC01_IC_DISH, 1<<(irq - irq_base - 32));
	38	}
	39
	40	/* unmask an interrupt */
e15883da	41	static inline void unmask_msc_irq(struct irq_data *d)
1da177e4	42	{
e15883da TG	43	unsigned int irq = d->irq;
e15883da TG	44
1da177e4 LT	45	if (irq < (irq_base + 32))
	46	MSCIC_WRITE(MSC01_IC_ENAL, 1<<(irq - irq_base));
	47	else
	48	MSCIC_WRITE(MSC01_IC_ENAH, 1<<(irq - irq_base - 32));
	49	}
	50
1da177e4 LT	51	/*
	52	* Masks and ACKs an IRQ
	53	*/
e15883da	54	static void level_mask_and_ack_msc_irq(struct irq_data *d)
1da177e4	55	{
e15883da	56	mask_msc_irq(d);
e01402b1	57	if (!cpu_has_veic)
1da177e4 LT	58	MSCIC_WRITE(MSC01_IC_EOI, 0);
	59	}
	60
	61	/*
	62	* Masks and ACKs an IRQ
	63	*/
e15883da	64	static void edge_mask_and_ack_msc_irq(struct irq_data *d)
1da177e4	65	{
e15883da TG	66	unsigned int irq = d->irq;
	67
	68	mask_msc_irq(d);
e01402b1	69	if (!cpu_has_veic)
1da177e4 LT	70	MSCIC_WRITE(MSC01_IC_EOI, 0);
	71	else {
	72	u32 r;
	73	MSCIC_READ(MSC01_IC_SUP+irq*8, r);
	74	MSCIC_WRITE(MSC01_IC_SUP+irq*8, r \| ~MSC01_IC_SUP_EDGE_BIT);
	75	MSCIC_WRITE(MSC01_IC_SUP+irq*8, r);
	76	}
	77	}
	78
1da177e4 LT	79	/*
	80	* Interrupt handler for interrupts coming from SOC-it.
	81	*/
937a8015	82	void ll_msc_irq(void)
1da177e4	83	{
70342287	84	unsigned int irq;
1da177e4 LT	85
	86	/* read the interrupt vector register */
	87	MSCIC_READ(MSC01_IC_VEC, irq);
	88	if (irq < 64)
937a8015	89	do_IRQ(irq + irq_base);
1da177e4 LT	90	else {
	91	/* Ignore spurious interrupt */
	92	}
	93	}
	94
411ba7fc	95	static void msc_bind_eic_interrupt(int irq, int set)
1da177e4 LT	96	{
	97	MSCIC_WRITE(MSC01_IC_RAMW,
	98	(irq<<MSC01_IC_RAMW_ADDR_SHF) \| (set<<MSC01_IC_RAMW_DATA_SHF));
	99	}
	100
411ba7fc	101	static struct irq_chip msc_levelirq_type = {
70d21cde	102	.name = "SOC-it-Level",
e15883da TG	103	.irq_ack = level_mask_and_ack_msc_irq,
	104	.irq_mask = mask_msc_irq,
	105	.irq_mask_ack = level_mask_and_ack_msc_irq,
	106	.irq_unmask = unmask_msc_irq,
	107	.irq_eoi = unmask_msc_irq,
1da177e4 LT	108	};
1da177e4 LT	109
411ba7fc	110	static struct irq_chip msc_edgeirq_type = {
70d21cde	111	.name = "SOC-it-Edge",
e15883da TG	112	.irq_ack = edge_mask_and_ack_msc_irq,
	113	.irq_mask = mask_msc_irq,
	114	.irq_mask_ack = edge_mask_and_ack_msc_irq,
	115	.irq_unmask = unmask_msc_irq,
	116	.irq_eoi = unmask_msc_irq,
1da177e4 LT	117	};
	118
	119
d725cf38	120	void __init init_msc_irqs(unsigned long icubase, unsigned int irqbase, msc_irqmap_t *imp, int nirq)
1da177e4	121	{
49a89efb	122	_icctrl_msc = (unsigned long) ioremap(icubase, 0x40000);
1da177e4 LT	123
	124	/* Reset interrupt controller - initialises all registers to 0 */
	125	MSCIC_WRITE(MSC01_IC_RST, MSC01_IC_RST_RST_BIT);
	126
	127	board_bind_eic_interrupt = &msc_bind_eic_interrupt;
	128
	129	for (; nirq >= 0; nirq--, imp++) {
	130	int n = imp->im_irq;
	131
	132	switch (imp->im_type) {
	133	case MSC01_IRQ_EDGE:
e4ec7989 TG	134	irq_set_chip_and_handler_name(irqbase + n,
	135	&msc_edgeirq_type,
	136	handle_edge_irq,
	137	"edge");
e01402b1	138	if (cpu_has_veic)
1da177e4 LT	139	MSCIC_WRITE(MSC01_IC_SUP+n*8, MSC01_IC_SUP_EDGE_BIT);
	140	else
	141	MSCIC_WRITE(MSC01_IC_SUP+n*8, MSC01_IC_SUP_EDGE_BIT \| imp->im_lvl);
	142	break;
	143	case MSC01_IRQ_LEVEL:
e4ec7989 TG	144	irq_set_chip_and_handler_name(irqbase + n,
	145	&msc_levelirq_type,
	146	handle_level_irq,
	147	"level");
e01402b1	148	if (cpu_has_veic)
1da177e4 LT	149	MSCIC_WRITE(MSC01_IC_SUP+n*8, 0);
	150	else
	151	MSCIC_WRITE(MSC01_IC_SUP+n*8, imp->im_lvl);
	152	}
	153	}
	154
d725cf38	155	irq_base = irqbase;
1da177e4 LT	156
	157	MSCIC_WRITE(MSC01_IC_GENA, MSC01_IC_GENA_GENA_BIT); /* Enable interrupt generation */
	158
	159	}