irq_imask.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:2k
- /* $Id: irq_imask.c,v 1.13 2001/07/12 08:13:56 gniibe Exp $
- *
- * linux/arch/sh/kernel/irq_imask.c
- *
- * Copyright (C) 1999, 2000 Niibe Yutaka
- *
- * Simple interrupt handling using IMASK of SR register.
- *
- */
- /* NOTE: Will not work on level 15 */
- #include <linux/ptrace.h>
- #include <linux/errno.h>
- #include <linux/kernel_stat.h>
- #include <linux/signal.h>
- #include <linux/sched.h>
- #include <linux/interrupt.h>
- #include <linux/init.h>
- #include <asm/system.h>
- #include <asm/irq.h>
- #include <asm/bitops.h>
- #include <linux/spinlock.h>
- #include <linux/cache.h>
- #include <linux/irq.h>
- /* Bitmap of IRQ masked */
- static unsigned long imask_mask = 0x7fff;
- static int interrupt_priority = 0;
- static void enable_imask_irq(unsigned int irq);
- static void disable_imask_irq(unsigned int irq);
- static void shutdown_imask_irq(unsigned int irq);
- static void mask_and_ack_imask(unsigned int);
- static void end_imask_irq(unsigned int irq);
- #define IMASK_PRIORITY 15
- static unsigned int startup_imask_irq(unsigned int irq)
- {
- /* Nothing to do */
- return 0; /* never anything pending */
- }
- static struct hw_interrupt_type imask_irq_type = {
- "SR.IMASK",
- startup_imask_irq,
- shutdown_imask_irq,
- enable_imask_irq,
- disable_imask_irq,
- mask_and_ack_imask,
- end_imask_irq
- };
- void static inline set_interrupt_registers(int ip)
- {
- unsigned long __dummy;
- asm volatile("ldc %2, r6_banknt"
- "stc sr, %0nt"
- "and #0xf0, %0nt"
- "shlr2 %0nt"
- "cmp/eq #0x3c, %0nt"
- "bt/s 1f ! CLI-ednt"
- " stc sr, %0nt"
- "and %1, %0nt"
- "or %2, %0nt"
- "ldc %0, srn"
- "1:"
- : "=&z" (__dummy)
- : "r" (~0xf0), "r" (ip << 4)
- : "t");
- }
- static void disable_imask_irq(unsigned int irq)
- {
- clear_bit(irq, &imask_mask);
- if (interrupt_priority < IMASK_PRIORITY - irq)
- interrupt_priority = IMASK_PRIORITY - irq;
- set_interrupt_registers(interrupt_priority);
- }
- static void enable_imask_irq(unsigned int irq)
- {
- set_bit(irq, &imask_mask);
- interrupt_priority = IMASK_PRIORITY - ffz(imask_mask);
- set_interrupt_registers(interrupt_priority);
- }
- static void mask_and_ack_imask(unsigned int irq)
- {
- disable_imask_irq(irq);
- }
- static void end_imask_irq(unsigned int irq)
- {
- if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
- enable_imask_irq(irq);
- }
- static void shutdown_imask_irq(unsigned int irq)
- {
- /* Nothing to do */
- }
- void make_imask_irq(unsigned int irq)
- {
- disable_irq_nosync(irq);
- irq_desc[irq].handler = &imask_irq_type;
- enable_irq(irq);
- }