sh: Convert r7780rp IRQ handler to IRQ chip.
Simple conversion of the R7780RP IRQ handler to struct irq_chip. Signed-off-by: Paul Mundt <lethal@linux-sh.org>
This commit is contained in:
@@ -1,18 +1,16 @@
|
|||||||
/*
|
/*
|
||||||
* linux/arch/sh/boards/renesas/r7780rp/irq.c
|
|
||||||
*
|
|
||||||
* Copyright (C) 2000 Kazumoto Kojima
|
|
||||||
*
|
|
||||||
* Renesas Solutions Highlander R7780RP-1 Support.
|
* Renesas Solutions Highlander R7780RP-1 Support.
|
||||||
*
|
*
|
||||||
* Modified for R7780RP-1 by
|
* Copyright (C) 2002 Atom Create Engineering Co., Ltd.
|
||||||
* Atom Create Engineering Co., Ltd. 2002.
|
* Copyright (C) 2006 Paul Mundt
|
||||||
|
*
|
||||||
|
* 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.
|
||||||
*/
|
*/
|
||||||
#include <linux/init.h>
|
#include <linux/init.h>
|
||||||
#include <linux/irq.h>
|
#include <linux/irq.h>
|
||||||
#include <asm/io.h>
|
#include <asm/io.h>
|
||||||
#include <asm/irq.h>
|
|
||||||
#include <asm/r7780rp/r7780rp.h>
|
|
||||||
|
|
||||||
#ifdef CONFIG_SH_R7780MP
|
#ifdef CONFIG_SH_R7780MP
|
||||||
static int mask_pos[] = {12, 11, 9, 14, 15, 8, 13, 6, 5, 4, 3, 2, 0, 0, 1, 0};
|
static int mask_pos[] = {12, 11, 9, 14, 15, 8, 13, 6, 5, 4, 3, 2, 0, 0, 1, 0};
|
||||||
@@ -20,71 +18,26 @@ static int mask_pos[] = {12, 11, 9, 14, 15, 8, 13, 6, 5, 4, 3, 2, 0, 0, 1, 0};
|
|||||||
static int mask_pos[] = {15, 14, 13, 12, 11, 10, 9, 8, 7, 5, 6, 4, 0, 1, 2, 0};
|
static int mask_pos[] = {15, 14, 13, 12, 11, 10, 9, 8, 7, 5, 6, 4, 0, 1, 2, 0};
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
static void enable_r7780rp_irq(unsigned int irq);
|
static void enable_r7780rp_irq(unsigned int irq)
|
||||||
static void disable_r7780rp_irq(unsigned int irq);
|
|
||||||
|
|
||||||
/* shutdown is same as "disable" */
|
|
||||||
#define shutdown_r7780rp_irq disable_r7780rp_irq
|
|
||||||
|
|
||||||
static void ack_r7780rp_irq(unsigned int irq);
|
|
||||||
static void end_r7780rp_irq(unsigned int irq);
|
|
||||||
|
|
||||||
static unsigned int startup_r7780rp_irq(unsigned int irq)
|
|
||||||
{
|
{
|
||||||
enable_r7780rp_irq(irq);
|
/* Set priority in IPR back to original value */
|
||||||
return 0; /* never anything pending */
|
ctrl_outw(ctrl_inw(IRLCNTR1) | (1 << mask_pos[irq]), IRLCNTR1);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void disable_r7780rp_irq(unsigned int irq)
|
static void disable_r7780rp_irq(unsigned int irq)
|
||||||
{
|
{
|
||||||
unsigned short val;
|
|
||||||
unsigned short mask = 0xffff ^ (0x0001 << mask_pos[irq]);
|
|
||||||
|
|
||||||
/* Set the priority in IPR to 0 */
|
/* Set the priority in IPR to 0 */
|
||||||
val = ctrl_inw(IRLCNTR1);
|
ctrl_outw(ctrl_inw(IRLCNTR1) & (0xffff ^ (1 << mask_pos[irq])),
|
||||||
val &= mask;
|
IRLCNTR1);
|
||||||
ctrl_outw(val, IRLCNTR1);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void enable_r7780rp_irq(unsigned int irq)
|
static struct irq_chip r7780rp_irq_chip __read_mostly = {
|
||||||
{
|
.name = "r7780rp",
|
||||||
unsigned short val;
|
.mask = disable_r7780rp_irq,
|
||||||
unsigned short value = (0x0001 << mask_pos[irq]);
|
.unmask = enable_r7780rp_irq,
|
||||||
|
.mask_ack = disable_r7780rp_irq,
|
||||||
/* Set priority in IPR back to original value */
|
|
||||||
val = ctrl_inw(IRLCNTR1);
|
|
||||||
val |= value;
|
|
||||||
ctrl_outw(val, IRLCNTR1);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void ack_r7780rp_irq(unsigned int irq)
|
|
||||||
{
|
|
||||||
disable_r7780rp_irq(irq);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void end_r7780rp_irq(unsigned int irq)
|
|
||||||
{
|
|
||||||
if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
|
|
||||||
enable_r7780rp_irq(irq);
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct hw_interrupt_type r7780rp_irq_type = {
|
|
||||||
.typename = "R7780RP-IRQ",
|
|
||||||
.startup = startup_r7780rp_irq,
|
|
||||||
.shutdown = shutdown_r7780rp_irq,
|
|
||||||
.enable = enable_r7780rp_irq,
|
|
||||||
.disable = disable_r7780rp_irq,
|
|
||||||
.ack = ack_r7780rp_irq,
|
|
||||||
.end = end_r7780rp_irq,
|
|
||||||
};
|
};
|
||||||
|
|
||||||
static void make_r7780rp_irq(unsigned int irq)
|
|
||||||
{
|
|
||||||
disable_irq_nosync(irq);
|
|
||||||
irq_desc[irq].chip = &r7780rp_irq_type;
|
|
||||||
disable_r7780rp_irq(irq);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Initialize IRQ setting
|
* Initialize IRQ setting
|
||||||
*/
|
*/
|
||||||
@@ -92,24 +45,10 @@ void __init init_r7780rp_IRQ(void)
|
|||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
/* IRL0=PCI Slot #A
|
for (i = 0; i < 15; i++) {
|
||||||
* IRL1=PCI Slot #B
|
disable_irq_nosync(i);
|
||||||
* IRL2=PCI Slot #C
|
set_irq_chip_and_handler(i, &r7780rp_irq_chip,
|
||||||
* IRL3=PCI Slot #D
|
handle_level_irq);
|
||||||
* IRL4=CF Card
|
disable_r7780rp_irq(i);
|
||||||
* IRL5=CF Card Insert
|
}
|
||||||
* IRL6=M66596
|
|
||||||
* IRL7=SD Card
|
|
||||||
* IRL8=Touch Panel
|
|
||||||
* IRL9=SCI
|
|
||||||
* IRL10=Serial
|
|
||||||
* IRL11=Extention #A
|
|
||||||
* IRL11=Extention #B
|
|
||||||
* IRL12=Debug LAN
|
|
||||||
* IRL13=Push Switch
|
|
||||||
* IRL14=ZiggBee IO
|
|
||||||
*/
|
|
||||||
|
|
||||||
for (i=0; i<15; i++)
|
|
||||||
make_r7780rp_irq(i);
|
|
||||||
}
|
}
|
||||||
|
Reference in New Issue
Block a user