sh: Convert IPR-IRQ to IRQ chip.
One more initial conversion.. Signed-off-by: Paul Mundt <lethal@linux-sh.org>
This commit is contained in:
@@ -1,11 +1,10 @@
|
|||||||
/*
|
/*
|
||||||
* arch/sh/kernel/cpu/irq/ipr.c
|
* Interrupt handling for IPR-based IRQ.
|
||||||
*
|
*
|
||||||
* Copyright (C) 1999 Niibe Yutaka & Takeshi Yaegashi
|
* Copyright (C) 1999 Niibe Yutaka & Takeshi Yaegashi
|
||||||
* Copyright (C) 2000 Kazumoto Kojima
|
* Copyright (C) 2000 Kazumoto Kojima
|
||||||
* Copyright (C) 2003 Takashi Kusuda <kusuda-takashi@hitachi-ul.co.jp>
|
* Copyright (C) 2003 Takashi Kusuda <kusuda-takashi@hitachi-ul.co.jp>
|
||||||
*
|
* Copyright (C) 2006 Paul Mundt
|
||||||
* Interrupt handling for IPR-based IRQ.
|
|
||||||
*
|
*
|
||||||
* Supported system:
|
* Supported system:
|
||||||
* On-chip supporting modules (TMU, RTC, etc.).
|
* On-chip supporting modules (TMU, RTC, etc.).
|
||||||
@@ -13,12 +12,13 @@
|
|||||||
* Hitachi SolutionEngine external I/O:
|
* Hitachi SolutionEngine external I/O:
|
||||||
* MS7709SE01, MS7709ASE01, and MS7750SE01
|
* MS7709SE01, MS7709ASE01, and MS7750SE01
|
||||||
*
|
*
|
||||||
|
* 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 <linux/module.h>
|
#include <linux/module.h>
|
||||||
|
|
||||||
#include <asm/system.h>
|
#include <asm/system.h>
|
||||||
#include <asm/io.h>
|
#include <asm/io.h>
|
||||||
#include <asm/machvec.h>
|
#include <asm/machvec.h>
|
||||||
@@ -28,93 +28,45 @@ struct ipr_data {
|
|||||||
int shift; /* Shifts of the 16-bit data */
|
int shift; /* Shifts of the 16-bit data */
|
||||||
int priority; /* The priority */
|
int priority; /* The priority */
|
||||||
};
|
};
|
||||||
static struct ipr_data ipr_data[NR_IRQS];
|
|
||||||
|
|
||||||
static void enable_ipr_irq(unsigned int irq);
|
|
||||||
static void disable_ipr_irq(unsigned int irq);
|
|
||||||
|
|
||||||
/* shutdown is same as "disable" */
|
|
||||||
#define shutdown_ipr_irq disable_ipr_irq
|
|
||||||
|
|
||||||
static void mask_and_ack_ipr(unsigned int);
|
|
||||||
static void end_ipr_irq(unsigned int irq);
|
|
||||||
|
|
||||||
static unsigned int startup_ipr_irq(unsigned int irq)
|
|
||||||
{
|
|
||||||
enable_ipr_irq(irq);
|
|
||||||
return 0; /* never anything pending */
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct hw_interrupt_type ipr_irq_type = {
|
|
||||||
.typename = "IPR-IRQ",
|
|
||||||
.startup = startup_ipr_irq,
|
|
||||||
.shutdown = shutdown_ipr_irq,
|
|
||||||
.enable = enable_ipr_irq,
|
|
||||||
.disable = disable_ipr_irq,
|
|
||||||
.ack = mask_and_ack_ipr,
|
|
||||||
.end = end_ipr_irq
|
|
||||||
};
|
|
||||||
|
|
||||||
static void disable_ipr_irq(unsigned int irq)
|
static void disable_ipr_irq(unsigned int irq)
|
||||||
{
|
{
|
||||||
unsigned long val;
|
struct ipr_data *p = get_irq_chip_data(irq);
|
||||||
unsigned int addr = ipr_data[irq].addr;
|
|
||||||
unsigned short mask = 0xffff ^ (0x0f << ipr_data[irq].shift);
|
|
||||||
|
|
||||||
/* Set the priority in IPR to 0 */
|
/* Set the priority in IPR to 0 */
|
||||||
val = ctrl_inw(addr);
|
ctrl_outw(ctrl_inw(p->addr) & (0xffff ^ (0xf << p->shift)), p->addr);
|
||||||
val &= mask;
|
|
||||||
ctrl_outw(val, addr);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void enable_ipr_irq(unsigned int irq)
|
static void enable_ipr_irq(unsigned int irq)
|
||||||
{
|
{
|
||||||
unsigned long val;
|
struct ipr_data *p = get_irq_chip_data(irq);
|
||||||
unsigned int addr = ipr_data[irq].addr;
|
|
||||||
int priority = ipr_data[irq].priority;
|
|
||||||
unsigned short value = (priority << ipr_data[irq].shift);
|
|
||||||
|
|
||||||
/* Set priority in IPR back to original value */
|
/* Set priority in IPR back to original value */
|
||||||
val = ctrl_inw(addr);
|
ctrl_outw(ctrl_inw(p->addr) | (p->priority << p->shift), p->addr);
|
||||||
val |= value;
|
|
||||||
ctrl_outw(val, addr);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mask_and_ack_ipr(unsigned int irq)
|
static struct irq_chip ipr_irq_chip = {
|
||||||
{
|
.name = "ipr",
|
||||||
disable_ipr_irq(irq);
|
.mask = disable_ipr_irq,
|
||||||
|
.unmask = enable_ipr_irq,
|
||||||
#if defined(CONFIG_CPU_SUBTYPE_SH7707) || defined(CONFIG_CPU_SUBTYPE_SH7709) || \
|
.mask_ack = disable_ipr_irq,
|
||||||
defined(CONFIG_CPU_SUBTYPE_SH7706) || \
|
};
|
||||||
defined(CONFIG_CPU_SUBTYPE_SH7300) || defined(CONFIG_CPU_SUBTYPE_SH7705)
|
|
||||||
/* This is needed when we use edge triggered setting */
|
|
||||||
/* XXX: Is it really needed? */
|
|
||||||
if (IRQ0_IRQ <= irq && irq <= IRQ5_IRQ) {
|
|
||||||
/* Clear external interrupt request */
|
|
||||||
int a = ctrl_inb(INTC_IRR0);
|
|
||||||
a &= ~(1 << (irq - IRQ0_IRQ));
|
|
||||||
ctrl_outb(a, INTC_IRR0);
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
static void end_ipr_irq(unsigned int irq)
|
|
||||||
{
|
|
||||||
if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
|
|
||||||
enable_ipr_irq(irq);
|
|
||||||
}
|
|
||||||
|
|
||||||
void make_ipr_irq(unsigned int irq, unsigned int addr, int pos, int priority)
|
void make_ipr_irq(unsigned int irq, unsigned int addr, int pos, int priority)
|
||||||
{
|
{
|
||||||
disable_irq_nosync(irq);
|
struct ipr_data ipr_data;
|
||||||
ipr_data[irq].addr = addr;
|
|
||||||
ipr_data[irq].shift = pos*4; /* POSition (0-3) x 4 means shift */
|
|
||||||
ipr_data[irq].priority = priority;
|
|
||||||
|
|
||||||
irq_desc[irq].chip = &ipr_irq_type;
|
disable_irq_nosync(irq);
|
||||||
disable_ipr_irq(irq);
|
|
||||||
|
ipr_data.addr = addr;
|
||||||
|
ipr_data.shift = pos*4; /* POSition (0-3) x 4 means shift */
|
||||||
|
ipr_data.priority = priority;
|
||||||
|
|
||||||
|
set_irq_chip_and_handler(irq, &ipr_irq_chip, handle_level_irq);
|
||||||
|
set_irq_chip_data(irq, &ipr_data);
|
||||||
|
|
||||||
|
enable_ipr_irq(irq);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* XXX: This needs to die a horrible death.. */
|
||||||
void __init init_IRQ(void)
|
void __init init_IRQ(void)
|
||||||
{
|
{
|
||||||
#ifndef CONFIG_CPU_SUBTYPE_SH7780
|
#ifndef CONFIG_CPU_SUBTYPE_SH7780
|
||||||
|
Reference in New Issue
Block a user