Subversion Repositories or1k

 /*

 * 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);

static void sun3_inthandle(int irq, void *dev_id, struct pt_regs *fp);

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);

}

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 */

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 const char *dev_names[SYS_IRQS] = { NULL, NULL, NULL, NULL,

                                     NULL, "timer", NULL, "int7 handler" };

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[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 sun3_get_irq_list(char *buf)

{

        int i, len = 0;

        for(i = 0; i < (SUN3_INT_VECS-1); i++) {

                if(sun3_vechandler[i] != NULL) {

                        len += sprintf(buf+len, "vec %3d: %10u %s\n", i+64,

                                       vec_ints[i],

                                       (vec_names[i]) ? vec_names[i] :

                                       "sun3_vechandler");

                }

        }

        return 0;

}

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_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;

                        vec_ints[vec] = 0;

                        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);

                vec_ints[vec]++;

                sun3_vechandler[vec](irq, vec_ids[vec], regs);

                return;

        } else {

                panic("sun3_process_int: unable to handle interrupt vector %d\n",

                      irq);

        }

}