Commit ebba61d5 authored by Roman Zippel's avatar Roman Zippel Committed by Linus Torvalds

[PATCH] m68k: convert sun3 irq code

Signed-off-by: default avatarRoman Zippel <zippel@linux-m68k.org>
Signed-off-by: default avatarAndrew Morton <akpm@osdl.org>
Signed-off-by: default avatarLinus Torvalds <torvalds@osdl.org>
parent 77dda339
...@@ -36,7 +36,6 @@ extern char _text, _end; ...@@ -36,7 +36,6 @@ extern char _text, _end;
char sun3_reserved_pmeg[SUN3_PMEGS_NUM]; char sun3_reserved_pmeg[SUN3_PMEGS_NUM];
extern unsigned long sun3_gettimeoffset(void); extern unsigned long sun3_gettimeoffset(void);
extern int show_sun3_interrupts (struct seq_file *, void *);
extern void sun3_sched_init(irqreturn_t (*handler)(int, void *, struct pt_regs *)); extern void sun3_sched_init(irqreturn_t (*handler)(int, void *, struct pt_regs *));
extern void sun3_get_model (char* model); extern void sun3_get_model (char* model);
extern void idprom_init (void); extern void idprom_init (void);
...@@ -147,13 +146,6 @@ void __init config_sun3(void) ...@@ -147,13 +146,6 @@ void __init config_sun3(void)
mach_sched_init = sun3_sched_init; mach_sched_init = sun3_sched_init;
mach_init_IRQ = sun3_init_IRQ; mach_init_IRQ = sun3_init_IRQ;
mach_default_handler = &sun3_default_handler;
mach_request_irq = sun3_request_irq;
mach_free_irq = sun3_free_irq;
enable_irq = sun3_enable_irq;
disable_irq = sun3_disable_irq;
mach_process_int = sun3_process_int;
mach_get_irq_list = show_sun3_interrupts;
mach_reset = sun3_reboot; mach_reset = sun3_reboot;
mach_gettimeoffset = sun3_gettimeoffset; mach_gettimeoffset = sun3_gettimeoffset;
mach_get_model = sun3_get_model; mach_get_model = sun3_get_model;
......
...@@ -19,7 +19,6 @@ ...@@ -19,7 +19,6 @@
#include <linux/seq_file.h> #include <linux/seq_file.h>
extern void sun3_leds (unsigned char); extern void sun3_leds (unsigned char);
static irqreturn_t sun3_inthandle(int irq, void *dev_id, struct pt_regs *fp);
void sun3_disable_interrupts(void) void sun3_disable_interrupts(void)
{ {
...@@ -40,48 +39,30 @@ int led_pattern[8] = { ...@@ -40,48 +39,30 @@ int led_pattern[8] = {
volatile unsigned char* sun3_intreg; volatile unsigned char* sun3_intreg;
void sun3_insert_irq(irq_node_t **list, irq_node_t *node)
{
}
void sun3_delete_irq(irq_node_t **list, void *dev_id)
{
}
void sun3_enable_irq(unsigned int irq) void sun3_enable_irq(unsigned int irq)
{ {
*sun3_intreg |= (1<<irq); *sun3_intreg |= (1 << irq);
} }
void sun3_disable_irq(unsigned int irq) void sun3_disable_irq(unsigned int irq)
{ {
*sun3_intreg &= ~(1<<irq); *sun3_intreg &= ~(1 << irq);
}
inline void sun3_do_irq(int irq, struct pt_regs *fp)
{
kstat_cpu(0).irqs[SYS_IRQS + irq]++;
*sun3_intreg &= ~(1<<irq);
*sun3_intreg |= (1<<irq);
} }
static irqreturn_t sun3_int7(int irq, void *dev_id, struct pt_regs *fp) static irqreturn_t sun3_int7(int irq, void *dev_id, struct pt_regs *fp)
{ {
sun3_do_irq(irq,fp); *sun3_intreg |= (1 << irq);
if(!(kstat_cpu(0).irqs[SYS_IRQS + irq] % 2000)) if (!(kstat_cpu(0).irqs[irq] % 2000))
sun3_leds(led_pattern[(kstat_cpu(0).irqs[SYS_IRQS+irq]%16000) sun3_leds(led_pattern[(kstat_cpu(0).irqs[irq] % 16000) / 2000]);
/2000]);
return IRQ_HANDLED; return IRQ_HANDLED;
} }
static irqreturn_t sun3_int5(int irq, void *dev_id, struct pt_regs *fp) static irqreturn_t sun3_int5(int irq, void *dev_id, struct pt_regs *fp)
{ {
kstat_cpu(0).irqs[SYS_IRQS + irq]++;
#ifdef CONFIG_SUN3 #ifdef CONFIG_SUN3
intersil_clear(); intersil_clear();
#endif #endif
*sun3_intreg &= ~(1<<irq); *sun3_intreg |= (1 << irq);
*sun3_intreg |= (1<<irq);
#ifdef CONFIG_SUN3 #ifdef CONFIG_SUN3
intersil_clear(); intersil_clear();
#endif #endif
...@@ -89,65 +70,8 @@ static irqreturn_t sun3_int5(int irq, void *dev_id, struct pt_regs *fp) ...@@ -89,65 +70,8 @@ static irqreturn_t sun3_int5(int irq, void *dev_id, struct pt_regs *fp)
#ifndef CONFIG_SMP #ifndef CONFIG_SMP
update_process_times(user_mode(fp)); update_process_times(user_mode(fp));
#endif #endif
if(!(kstat_cpu(0).irqs[SYS_IRQS + irq] % 20)) if (!(kstat_cpu(0).irqs[irq] % 20))
sun3_leds(led_pattern[(kstat_cpu(0).irqs[SYS_IRQS+irq]%160) sun3_leds(led_pattern[(kstat_cpu(0).irqs[irq] % 160) / 20]);
/20]);
return IRQ_HANDLED;
}
/* handle requested ints, excepting 5 and 7, which always do the same
thing */
irqreturn_t (*sun3_default_handler[SYS_IRQS])(int, void *, struct pt_regs *) = {
[0] = sun3_inthandle,
[1] = sun3_inthandle,
[2] = sun3_inthandle,
[3] = sun3_inthandle,
[4] = sun3_inthandle,
[5] = sun3_int5,
[6] = sun3_inthandle,
[7] = sun3_int7
};
static const char *dev_names[SYS_IRQS] = {
[5] = "timer",
[7] = "int7 handler"
};
static void *dev_ids[SYS_IRQS];
static irqreturn_t (*sun3_inthandler[SYS_IRQS])(int, void *, struct pt_regs *) = {
[5] = sun3_int5,
[7] = sun3_int7
};
static irqreturn_t (*sun3_vechandler[SUN3_INT_VECS])(int, void *, struct pt_regs *);
static void *vec_ids[SUN3_INT_VECS];
static const char *vec_names[SUN3_INT_VECS];
static int vec_ints[SUN3_INT_VECS];
int show_sun3_interrupts(struct seq_file *p, void *v)
{
int i;
for(i = 0; i < (SUN3_INT_VECS-1); i++) {
if(sun3_vechandler[i] != NULL) {
seq_printf(p, "vec %3d: %10u %s\n", i+64,
vec_ints[i],
(vec_names[i]) ? vec_names[i] :
"sun3_vechandler");
}
}
return 0;
}
static irqreturn_t sun3_inthandle(int irq, void *dev_id, struct pt_regs *fp)
{
if(sun3_inthandler[irq] == NULL)
panic ("bad interrupt %d received (id %p)\n",irq, dev_id);
kstat_cpu(0).irqs[SYS_IRQS + irq]++;
*sun3_intreg &= ~(1<<irq);
sun3_inthandler[irq](irq, dev_ids[irq], fp);
return IRQ_HANDLED; return IRQ_HANDLED;
} }
...@@ -157,109 +81,31 @@ static irqreturn_t sun3_vec255(int irq, void *dev_id, struct pt_regs *fp) ...@@ -157,109 +81,31 @@ static irqreturn_t sun3_vec255(int irq, void *dev_id, struct pt_regs *fp)
return IRQ_HANDLED; return IRQ_HANDLED;
} }
void sun3_init_IRQ(void) static void sun3_inthandle(unsigned int irq, struct pt_regs *fp)
{ {
int i; *sun3_intreg &= ~(1 << irq);
*sun3_intreg = 1;
for(i = 0; i < SYS_IRQS; i++)
{
if(dev_names[i])
cpu_request_irq(i, sun3_default_handler[i], 0,
dev_names[i], NULL);
}
for(i = 0; i < 192; i++)
sun3_vechandler[i] = NULL;
sun3_vechandler[191] = sun3_vec255;
}
int sun3_request_irq(unsigned int irq, irqreturn_t (*handler)(int, void *, struct pt_regs *),
unsigned long flags, const char *devname, void *dev_id)
{
if(irq < SYS_IRQS) {
if(sun3_inthandler[irq] != NULL) {
printk("sun3_request_irq: request for irq %d -- already taken!\n", irq);
return 1;
}
sun3_inthandler[irq] = handler;
dev_ids[irq] = dev_id;
dev_names[irq] = devname;
/* setting devname would be nice */
cpu_request_irq(irq, sun3_default_handler[irq], 0, devname,
NULL);
return 0;
} else {
if((irq >= 64) && (irq <= 255)) {
int vec;
vec = irq - 64;
if(sun3_vechandler[vec] != NULL) {
printk("sun3_request_irq: request for vec %d -- already taken!\n", irq);
return 1;
}
sun3_vechandler[vec] = handler;
vec_ids[vec] = dev_id;
vec_names[vec] = devname;
vec_ints[vec] = 0;
return 0;
}
}
printk("sun3_request_irq: invalid irq %d\n", irq);
return 1;
m68k_handle_int(irq, fp);
} }
void sun3_free_irq(unsigned int irq, void *dev_id) static struct irq_controller sun3_irq_controller = {
{ .name = "sun3",
.lock = SPIN_LOCK_UNLOCKED,
if(irq < SYS_IRQS) { .startup = m68k_irq_startup,
if(sun3_inthandler[irq] == NULL) .shutdown = m68k_irq_shutdown,
panic("sun3_free_int: attempt to free unused irq %d\n", irq); .enable = sun3_enable_irq,
if(dev_ids[irq] != dev_id) .disable = sun3_disable_irq,
panic("sun3_free_int: incorrect dev_id for irq %d\n", irq); };
sun3_inthandler[irq] = NULL;
return;
} else if((irq >= 64) && (irq <= 255)) {
int vec;
vec = irq - 64;
if(sun3_vechandler[vec] == NULL)
panic("sun3_free_int: attempt to free unused vector %d\n", irq);
if(vec_ids[irq] != dev_id)
panic("sun3_free_int: incorrect dev_id for vec %d\n", irq);
sun3_vechandler[vec] = NULL;
return;
} else {
panic("sun3_free_irq: invalid irq %d\n", irq);
}
}
irqreturn_t sun3_process_int(int irq, struct pt_regs *regs) void sun3_init_IRQ(void)
{ {
*sun3_intreg = 1;
if((irq >= 64) && (irq <= 255)) { m68k_setup_auto_interrupt(sun3_inthandle);
int vec; m68k_setup_irq_controller(&sun3_irq_controller, IRQ_AUTO_1, 7);
m68k_setup_user_interrupt(VEC_USER, 192, NULL);
vec = irq - 64;
if(sun3_vechandler[vec] == NULL)
panic ("bad interrupt vector %d received\n",irq);
vec_ints[vec]++; request_irq(IRQ_AUTO_5, sun3_int5, 0, "int5", NULL);
return sun3_vechandler[vec](irq, vec_ids[vec], regs); request_irq(IRQ_AUTO_7, sun3_int7, 0, "int7", NULL);
} else { request_irq(IRQ_USER+127, sun3_vec255, 0, "vec255", NULL);
panic("sun3_process_int: unable to handle interrupt vector %d\n",
irq);
}
} }
...@@ -52,17 +52,10 @@ void __init config_sun3x(void) ...@@ -52,17 +52,10 @@ void __init config_sun3x(void)
sun3x_prom_init(); sun3x_prom_init();
mach_get_irq_list = show_sun3_interrupts;
mach_max_dma_address = 0xffffffff; /* we can DMA anywhere, whee */ mach_max_dma_address = 0xffffffff; /* we can DMA anywhere, whee */
mach_default_handler = &sun3_default_handler;
mach_sched_init = sun3x_sched_init; mach_sched_init = sun3x_sched_init;
mach_init_IRQ = sun3_init_IRQ; mach_init_IRQ = sun3_init_IRQ;
enable_irq = sun3_enable_irq;
disable_irq = sun3_disable_irq;
mach_request_irq = sun3_request_irq;
mach_free_irq = sun3_free_irq;
mach_process_int = sun3_process_int;
mach_gettimeoffset = sun3x_gettimeoffset; mach_gettimeoffset = sun3x_gettimeoffset;
mach_reset = sun3x_reboot; mach_reset = sun3x_reboot;
......
...@@ -12,37 +12,25 @@ ...@@ -12,37 +12,25 @@
#define SUN3INTS_H #define SUN3INTS_H
#include <linux/types.h> #include <linux/types.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/kernel_stat.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/seq_file.h>
#include <asm/segment.h>
#include <asm/intersil.h> #include <asm/intersil.h>
#include <asm/oplib.h> #include <asm/oplib.h>
#include <asm/traps.h>
#define SUN3_INT_VECS 192 #define SUN3_INT_VECS 192
void sun3_enable_irq(unsigned int irq); void sun3_enable_irq(unsigned int irq);
void sun3_disable_irq(unsigned int irq); void sun3_disable_irq(unsigned int irq);
int sun3_request_irq(unsigned int irq,
irqreturn_t (*handler)(int, void *, struct pt_regs *),
unsigned long flags, const char *devname, void *dev_id
);
extern void sun3_init_IRQ (void); extern void sun3_init_IRQ (void);
extern irqreturn_t (*sun3_default_handler[]) (int, void *, struct pt_regs *);
extern void sun3_free_irq (unsigned int irq, void *dev_id);
extern void sun3_enable_interrupts (void); extern void sun3_enable_interrupts (void);
extern void sun3_disable_interrupts (void); extern void sun3_disable_interrupts (void);
extern int show_sun3_interrupts(struct seq_file *, void *);
extern irqreturn_t sun3_process_int(int, struct pt_regs *);
extern volatile unsigned char* sun3_intreg; extern volatile unsigned char* sun3_intreg;
/* master list of VME vectors -- don't fuck with this */ /* master list of VME vectors -- don't fuck with this */
#define SUN3_VEC_FLOPPY 0x40 #define SUN3_VEC_FLOPPY (IRQ_USER+0)
#define SUN3_VEC_VMESCSI0 0x40 #define SUN3_VEC_VMESCSI0 (IRQ_USER+0)
#define SUN3_VEC_VMESCSI1 0x41 #define SUN3_VEC_VMESCSI1 (IRQ_USER+1)
#define SUN3_VEC_CG 0xA8 #define SUN3_VEC_CG (IRQ_USER+104)
#endif /* SUN3INTS_H */ #endif /* SUN3INTS_H */
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment