Viewing file:  sun3ints.c (5.21 KB) -rw-r--r--
Select action/file-type:
 (+) |  (+) |  (+) | Code (+) | Session (+) |  (+) | SDB (+) |  (+) |  (+) |  (+) |  (+) |  (+) |
/*
* linux/arch/m68k/sun3/sun3ints.c -- Sun-3(x) Linux interrupt handling code
*
* 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/types.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/kernel_stat.h>
#include <linux/interrupt.h>
#include <asm/segment.h>
#include <asm/intersil.h>
#include <asm/oplib.h>
#include <asm/sun3ints.h>
extern void sun3_leds (unsigned char);
void sun3_disable_interrupts(void)
{
sun3_disable_irq(0);
}
void sun3_enable_interrupts(void)
{
sun3_enable_irq(0);
}
int led_pattern[8] = {
~(0x80), ~(0x01),
~(0x40), ~(0x02),
~(0x20), ~(0x04),
~(0x10), ~(0x08)
};
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)
{
*sun3_intreg |= (1<<irq);
}
void sun3_disable_irq(unsigned int irq)
{
*sun3_intreg &= ~(1<<irq);
}
inline void sun3_do_irq(int irq, struct pt_regs *fp)
{
kstat.irqs[0][SYS_IRQS + irq]++;
*sun3_intreg &= ~(1<<irq);
*sun3_intreg |= (1<<irq);
}
int sun3_get_irq_list(char *buf)
{
return 0;
}
static void sun3_int7(int irq, void *dev_id, struct pt_regs *fp)
{
sun3_do_irq(irq,fp);
if(!(kstat.irqs[0][SYS_IRQS + irq] % 2000))
sun3_leds(led_pattern[(kstat.irqs[0][SYS_IRQS+irq]%16000)/2000]);
}
static void sun3_int5(int irq, void *dev_id, struct pt_regs *fp)
{
kstat.irqs[0][SYS_IRQS + irq]++;
#ifdef CONFIG_SUN3
intersil_clear();
#endif
*sun3_intreg &= ~(1<<irq);
*sun3_intreg |= (1<<irq);
#ifdef CONFIG_SUN3
intersil_clear();
#endif
do_timer(fp);
if(!(kstat.irqs[0][SYS_IRQS + irq] % 20))
sun3_leds(led_pattern[(kstat.irqs[0][SYS_IRQS+irq]%160)
/20]);
}
/* handle requested ints, excepting 5 and 7, which always do the same
thing */
static void *dev_ids[SYS_IRQS];
static void (*sun3_inthandler[SYS_IRQS])(int, void *, struct pt_regs *) = {
NULL, NULL, NULL, NULL, NULL, sun3_int5, NULL, sun3_int7
};
static void (*sun3_vechandler[192])(int, void *, struct pt_regs *);
static void *vec_ids[192];
static char *vec_names[192];
static void 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.irqs[0][SYS_IRQS + irq]++;
*sun3_intreg &= ~(1<<irq);
sun3_inthandler[irq](irq, dev_ids[irq], fp);
}
static void sun3_vec255(int irq, void *dev_id, struct pt_regs *fp)
{
// intersil_clear();
}
void (*sun3_default_handler[SYS_IRQS])(int, void *, struct pt_regs *) = {
sun3_inthandle, sun3_inthandle, sun3_inthandle, sun3_inthandle,
sun3_inthandle, sun3_int5, sun3_inthandle, sun3_int7
};
static char *dev_names[SYS_IRQS] = { NULL, NULL, NULL, NULL,
NULL, "timer", NULL, NULL };
void sun3_init_IRQ(void)
{
int i;
*sun3_intreg = 1;
for(i = 0; i < SYS_IRQS; i++)
{
if(dev_names[i])
sys_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, void (*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 */
sys_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;
return 0;
}
}
printk("sun3_request_irq: invalid irq %d\n", irq);
return 1;
}
void sun3_free_irq(unsigned int irq, void *dev_id)
{
if(irq < SYS_IRQS) {
if(sun3_inthandler[irq] == NULL)
panic("sun3_free_int: attempt to free unused irq %d\n", irq);
if(dev_ids[irq] != dev_id)
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);
}
}
void sun3_process_int(int irq, struct pt_regs *regs)
{
if((irq >= 64) && (irq <= 255)) {
int vec;
vec = irq - 64;
if(sun3_vechandler[vec] == NULL)
panic ("bad interrupt vector %d received\n",irq);
sun3_vechandler[vec](irq, vec_ids[vec], regs);
return;
} else {
panic("sun3_process_int: unable to handle interrupt vector %d\n",
irq);
}
}
|