Subversion Repositories or1k_old

/*

 * ints.c -- 680x0 Linux general 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.

 *

 * 07/03/96: Timer initialization, and thus mach_sched_init(),

 *           removed from request_irq() and moved to init_time().

 *           We should therefore consider renaming our add_isr() and

 *           remove_isr() to request_irq() and free_irq()

 *           respectively, so they are compliant with the other

 *           architectures.                                     /Jes

 */

#include <linux/types.h>

#include <linux/sched.h>

#include <linux/kernel_stat.h>

#include <linux/errno.h>

#include <asm/system.h>

#include <asm/irq.h>

#include <asm/traps.h>

#include <asm/page.h>

#include <asm/machdep.h>

/* list is accessed 0-6 for IRQs 1-7 */

static isr_node_t *isr_list[7];

/* The number of spurious interrupts */

volatile unsigned long num_spurious;

/*

unsigned long interrupt_stack[PAGE_SIZE/sizeof(long)];

*/

/*

 * void init_IRQ(void)

 *

 * Parameters:  None

 *

 * Returns:     Nothing

 *

 * This function should be called during kernel startup to initialize

 * the IRQ handling routines.

 */

void init_IRQ(void)

{

    /* Setup interrupt stack pointer */

  /*

    asm ("movec %0,%/isp"

         : : "r" (interrupt_stack + sizeof (interrupt_stack) / sizeof (long)));

         */

    mach_init_INTS ();

}

void insert_isr (isr_node_t **listp, isr_node_t *node)

{

    unsigned long spl;

    isr_node_t *cur;

    save_flags(spl);

    cli();

    cur = *listp;

    while (cur && cur->pri <= node->pri)

    {

        listp = &cur->next;

        cur = cur->next;

    }

    node->next = cur;

    *listp = node;

    restore_flags(spl);

}

void delete_isr (isr_node_t **listp, isrfunc isr, void *data)

{

    unsigned long flags;

    isr_node_t *np;

    save_flags(flags);

    cli();

    for (np = *listp; np; listp = &np->next, np = *listp) {

        if (np->isr == isr && np->data == data) {

            *listp = np->next;

            /* Mark it as free. */

            np->isr = NULL;

            restore_flags(flags);

            return;

        }

    }

    restore_flags(flags);

    printk ("delete_isr: isr %p not found on list!\n", isr);

}

#define NUM_ISR_NODES 100

static isr_node_t nodes[NUM_ISR_NODES];

isr_node_t *new_isr_node(void)

{

    isr_node_t *np;

    for (np = nodes; np < &nodes[NUM_ISR_NODES]; np++)

        if (np->isr == NULL)

            return np;

    printk ("new_isr_node: out of nodes");

    return NULL;

}

int add_isr (unsigned long source, isrfunc isr, int pri, void *data,

             char *name)

{

    isr_node_t *p;

    if (source & IRQ_MACHSPEC)

    {

        return mach_add_isr (source, isr, pri, data, name);

    }

    if (source < IRQ1 || source > IRQ7)

        panic ("add_isr: Incorrect IRQ source %ld from %s\n", source, name);

    p = new_isr_node();

    if (p == NULL)

        return 0;

    p->isr = isr;

    p->pri = pri;

    p->data = data;

    p->name = name;

    p->next = NULL;

    insert_isr (&isr_list[source-1], p);

    return 1;

}

int remove_isr (unsigned long source, isrfunc isr, void *data)

{

    if (source & IRQ_MACHSPEC)

        return mach_remove_isr (source, isr, data);

    if (source < IRQ1 || source > IRQ7) {

        printk ("remove_isr: Incorrect IRQ source %ld\n", source);

        return 0;

    }

    delete_isr (&isr_list[source - 1], isr, data);

    return 1;

}

void call_isr_list(int irq, isr_node_t *p, struct pt_regs *fp)

{

    while (p) {

        p->isr (irq, fp, p->data);

        p = p->next;

    }

}

asmlinkage void process_int(int vec, struct pt_regs *regs)

{

        int level;

        if (vec >= VECOFF(VEC_INT1) && vec <= VECOFF(VEC_INT7))

                level = (vec - VECOFF(VEC_SPUR)) >> 2;

        else {

                if (mach_process_int)

                        mach_process_int(vec, regs);

                else

                        panic("Can't process interrupt vector 0x%03x\n", vec);

                return;

        }

        kstat.interrupts[level]++;

        call_isr_list (level, isr_list[level-1], regs);

}

int request_irq(unsigned int irq,

                void (*handler)(int, void *, struct pt_regs *),

                unsigned long flags, const char * devname, void *dev_id)

{

        return -EINVAL;

}

void free_irq(unsigned int irq, void *dev_id)

{

}

/*

 * Do we need these probe functions on the m68k?

 */

unsigned long probe_irq_on (void)

{

  return 0;

}

int probe_irq_off (unsigned long irqs)

{

  return 0;

}

void enable_irq(unsigned int irq_nr)

{

        if ((irq_nr & IRQ_MACHSPEC) && mach_enable_irq)

                mach_enable_irq(irq_nr);

}

void disable_irq(unsigned int irq_nr)

{

        if ((irq_nr & IRQ_MACHSPEC) && mach_disable_irq)

                mach_disable_irq(irq_nr);

}

int get_irq_list(char *buf)

{

    int i, len = 0;

    isr_node_t *p;

    /* autovector interrupts */

    for (i = IRQ1; i <= IRQ7; ++i) {

        if (!isr_list[i-1])

            continue;

        len += sprintf(buf+len, "auto %2d: %8d ", i, kstat.interrupts[i]);

        for (p = isr_list[i-1]; p; p = p->next) {

            len += sprintf(buf+len, "%s\n", p->name);

            if (p->next)

                len += sprintf(buf+len, "                  ");

        }

    }

    len = mach_get_irq_list(buf, len);

    return len;

}