irq_imask.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:2k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: irq_imask.c,v 1.13 2001/07/12 08:13:56 gniibe Exp $
  2.  *
  3.  * linux/arch/sh/kernel/irq_imask.c
  4.  *
  5.  * Copyright (C) 1999, 2000  Niibe Yutaka
  6.  *
  7.  * Simple interrupt handling using IMASK of SR register.
  8.  *
  9.  */
  10. /* NOTE: Will not work on level 15 */
  11. #include <linux/ptrace.h>
  12. #include <linux/errno.h>
  13. #include <linux/kernel_stat.h>
  14. #include <linux/signal.h>
  15. #include <linux/sched.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/init.h>
  18. #include <asm/system.h>
  19. #include <asm/irq.h>
  20. #include <asm/bitops.h>
  21. #include <linux/spinlock.h>
  22. #include <linux/cache.h>
  23. #include <linux/irq.h>
  24. /* Bitmap of IRQ masked */
  25. static unsigned long imask_mask = 0x7fff;
  26. static int interrupt_priority = 0;
  27. static void enable_imask_irq(unsigned int irq);
  28. static void disable_imask_irq(unsigned int irq);
  29. static void shutdown_imask_irq(unsigned int irq);
  30. static void mask_and_ack_imask(unsigned int);
  31. static void end_imask_irq(unsigned int irq);
  32. #define IMASK_PRIORITY 15
  33. static unsigned int startup_imask_irq(unsigned int irq)
  34. /* Nothing to do */
  35. return 0; /* never anything pending */
  36. }
  37. static struct hw_interrupt_type imask_irq_type = {
  38. "SR.IMASK",
  39. startup_imask_irq,
  40. shutdown_imask_irq,
  41. enable_imask_irq,
  42. disable_imask_irq,
  43. mask_and_ack_imask,
  44. end_imask_irq
  45. };
  46. void static inline set_interrupt_registers(int ip)
  47. {
  48. unsigned long __dummy;
  49. asm volatile("ldc %2, r6_banknt"
  50.      "stc sr, %0nt"
  51.      "and #0xf0, %0nt"
  52.      "shlr2 %0nt"
  53.      "cmp/eq #0x3c, %0nt"
  54.      "bt/s 1f ! CLI-ednt"
  55.      " stc sr, %0nt"
  56.      "and %1, %0nt"
  57.      "or %2, %0nt"
  58.      "ldc %0, srn"
  59.      "1:"
  60.      : "=&z" (__dummy)
  61.      : "r" (~0xf0), "r" (ip << 4)
  62.      : "t");
  63. }
  64. static void disable_imask_irq(unsigned int irq)
  65. {
  66. clear_bit(irq, &imask_mask);
  67. if (interrupt_priority < IMASK_PRIORITY - irq)
  68. interrupt_priority = IMASK_PRIORITY - irq;
  69. set_interrupt_registers(interrupt_priority);
  70. }
  71. static void enable_imask_irq(unsigned int irq)
  72. {
  73. set_bit(irq, &imask_mask);
  74. interrupt_priority = IMASK_PRIORITY - ffz(imask_mask);
  75. set_interrupt_registers(interrupt_priority);
  76. }
  77. static void mask_and_ack_imask(unsigned int irq)
  78. {
  79. disable_imask_irq(irq);
  80. }
  81. static void end_imask_irq(unsigned int irq)
  82. {
  83. if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
  84. enable_imask_irq(irq);
  85. }
  86. static void shutdown_imask_irq(unsigned int irq)
  87. {
  88. /* Nothing to do */
  89. }
  90. void make_imask_irq(unsigned int irq)
  91. {
  92. disable_irq_nosync(irq);
  93. irq_desc[irq].handler = &imask_irq_type;
  94. enable_irq(irq);
  95. }