1603b5aca4
This is a big irq cleanup patch. * Use set_irq_chip() to register irq_chip. * Initialize .mask, .unmask, .mask_ack field. Functions for these method are already exist in most case. * Do not initialize .startup, .shutdown, .enable, .disable fields if default routines provided by irq_chip_set_defaults() were suitable. * Remove redundant irq_desc initializations. * Remove unnecessary local_irq_save/local_irq_restore, spin_lock. With this cleanup, it would be easy to switch to slightly lightwait irq flow handlers (handle_level_irq(), etc.) instead of __do_IRQ(). Though whole this patch is quite large, changes in each irq_chip are not quite simple. Please review and test on your platform. Thanks. Signed-off-by: Atsushi Nemoto <anemo@mba.ocn.ne.jp> Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
120 lines
3.1 KiB
C
120 lines
3.1 KiB
C
/*
|
|
* Copyright 2002 Momentum Computer
|
|
* Author: mdharm@momenco.com
|
|
* Copyright (C) 2004, 06 Ralf Baechle <ralf@linux-mips.org>
|
|
*
|
|
* 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/module.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/kernel_stat.h>
|
|
#include <linux/mv643xx.h>
|
|
#include <linux/sched.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/marvell.h>
|
|
|
|
static unsigned int irq_base;
|
|
|
|
static inline int ls1bit32(unsigned int x)
|
|
{
|
|
int b = 31, s;
|
|
|
|
s = 16; if (x << 16 == 0) s = 0; b -= s; x <<= s;
|
|
s = 8; if (x << 8 == 0) s = 0; b -= s; x <<= s;
|
|
s = 4; if (x << 4 == 0) s = 0; b -= s; x <<= s;
|
|
s = 2; if (x << 2 == 0) s = 0; b -= s; x <<= s;
|
|
s = 1; if (x << 1 == 0) s = 0; b -= s;
|
|
|
|
return b;
|
|
}
|
|
|
|
/* mask off an interrupt -- 1 is enable, 0 is disable */
|
|
static inline void mask_mv64340_irq(unsigned int irq)
|
|
{
|
|
uint32_t value;
|
|
|
|
if (irq < (irq_base + 32)) {
|
|
value = MV_READ(MV64340_INTERRUPT0_MASK_0_LOW);
|
|
value &= ~(1 << (irq - irq_base));
|
|
MV_WRITE(MV64340_INTERRUPT0_MASK_0_LOW, value);
|
|
} else {
|
|
value = MV_READ(MV64340_INTERRUPT0_MASK_0_HIGH);
|
|
value &= ~(1 << (irq - irq_base - 32));
|
|
MV_WRITE(MV64340_INTERRUPT0_MASK_0_HIGH, value);
|
|
}
|
|
}
|
|
|
|
/* unmask an interrupt -- 1 is enable, 0 is disable */
|
|
static inline void unmask_mv64340_irq(unsigned int irq)
|
|
{
|
|
uint32_t value;
|
|
|
|
if (irq < (irq_base + 32)) {
|
|
value = MV_READ(MV64340_INTERRUPT0_MASK_0_LOW);
|
|
value |= 1 << (irq - irq_base);
|
|
MV_WRITE(MV64340_INTERRUPT0_MASK_0_LOW, value);
|
|
} else {
|
|
value = MV_READ(MV64340_INTERRUPT0_MASK_0_HIGH);
|
|
value |= 1 << (irq - irq_base - 32);
|
|
MV_WRITE(MV64340_INTERRUPT0_MASK_0_HIGH, value);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* End IRQ processing
|
|
*/
|
|
static void end_mv64340_irq(unsigned int irq)
|
|
{
|
|
if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
|
|
unmask_mv64340_irq(irq);
|
|
}
|
|
|
|
/*
|
|
* Interrupt handler for interrupts coming from the Marvell chip.
|
|
* It could be built in ethernet ports etc...
|
|
*/
|
|
void ll_mv64340_irq(void)
|
|
{
|
|
unsigned int irq_src_low, irq_src_high;
|
|
unsigned int irq_mask_low, irq_mask_high;
|
|
|
|
/* read the interrupt status registers */
|
|
irq_mask_low = MV_READ(MV64340_INTERRUPT0_MASK_0_LOW);
|
|
irq_mask_high = MV_READ(MV64340_INTERRUPT0_MASK_0_HIGH);
|
|
irq_src_low = MV_READ(MV64340_MAIN_INTERRUPT_CAUSE_LOW);
|
|
irq_src_high = MV_READ(MV64340_MAIN_INTERRUPT_CAUSE_HIGH);
|
|
|
|
/* mask for just the interrupts we want */
|
|
irq_src_low &= irq_mask_low;
|
|
irq_src_high &= irq_mask_high;
|
|
|
|
if (irq_src_low)
|
|
do_IRQ(ls1bit32(irq_src_low) + irq_base);
|
|
else
|
|
do_IRQ(ls1bit32(irq_src_high) + irq_base + 32);
|
|
}
|
|
|
|
struct irq_chip mv64340_irq_type = {
|
|
.typename = "MV-64340",
|
|
.ack = mask_mv64340_irq,
|
|
.mask = mask_mv64340_irq,
|
|
.mask_ack = mask_mv64340_irq,
|
|
.unmask = unmask_mv64340_irq,
|
|
.end = end_mv64340_irq,
|
|
};
|
|
|
|
void __init mv64340_irq_init(unsigned int base)
|
|
{
|
|
int i;
|
|
|
|
for (i = base; i < base + 64; i++)
|
|
set_irq_chip(i, &mv64340_irq_type);
|
|
|
|
irq_base = base;
|
|
}
|