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

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * BK Id: SCCS/s.ints.c 1.5 05/17/01 18:14:20 cort
  3.  */
  4. /*
  5.  *  linux/arch/ppc/amiga/ints.c
  6.  *
  7.  *  Linux/m68k general interrupt handling code from arch/m68k/kernel/ints.c
  8.  *  Needed to drive the m68k emulating IRQ hardware on the PowerUp boards.
  9.  */
  10. #include <linux/types.h>
  11. #include <linux/sched.h>
  12. #include <linux/kernel_stat.h>
  13. #include <linux/errno.h>
  14. #include <linux/init.h>
  15. #include <asm/setup.h>
  16. #include <asm/system.h>
  17. #include <asm/irq.h>
  18. #include <asm/traps.h>
  19. #include <asm/page.h>
  20. #include <asm/machdep.h>
  21. /* table for system interrupt handlers */
  22. static irq_handler_t irq_list[SYS_IRQS];
  23. static const char *default_names[SYS_IRQS] = {
  24. "spurious int", "int1 handler", "int2 handler", "int3 handler",
  25. "int4 handler", "int5 handler", "int6 handler", "int7 handler"
  26. };
  27. /* The number of spurious interrupts */
  28. volatile unsigned int num_spurious;
  29. #define NUM_IRQ_NODES 100
  30. static irq_node_t nodes[NUM_IRQ_NODES];
  31. /*
  32.  * void init_IRQ(void)
  33.  *
  34.  * Parameters: None
  35.  *
  36.  * Returns: Nothing
  37.  *
  38.  * This function should be called during kernel startup to initialize
  39.  * the IRQ handling routines.
  40.  */
  41. __init
  42. void m68k_init_IRQ(void)
  43. {
  44. int i;
  45. for (i = 0; i < SYS_IRQS; i++) {
  46. if (mach_default_handler)
  47. irq_list[i].handler = (*mach_default_handler)[i];
  48. irq_list[i].flags   = 0;
  49. irq_list[i].dev_id  = NULL;
  50. irq_list[i].devname = default_names[i];
  51. }
  52. for (i = 0; i < NUM_IRQ_NODES; i++)
  53. nodes[i].handler = NULL;
  54. mach_init_IRQ ();
  55. }
  56. irq_node_t *new_irq_node(void)
  57. {
  58. irq_node_t *node;
  59. short i;
  60. for (node = nodes, i = NUM_IRQ_NODES-1; i >= 0; node++, i--)
  61. if (!node->handler)
  62. return node;
  63. printk ("new_irq_node: out of nodesn");
  64. return NULL;
  65. }
  66. int sys_request_irq(unsigned int irq, 
  67.                     void (*handler)(int, void *, struct pt_regs *), 
  68.                     unsigned long flags, const char *devname, void *dev_id)
  69. {
  70. if (irq < IRQ1 || irq > IRQ7) {
  71. printk("%s: Incorrect IRQ %d from %sn",
  72.        __FUNCTION__, irq, devname);
  73. return -ENXIO;
  74. }
  75. #if 0
  76. if (!(irq_list[irq].flags & IRQ_FLG_STD)) {
  77. if (irq_list[irq].flags & IRQ_FLG_LOCK) {
  78. printk("%s: IRQ %d from %s is not replaceablen",
  79.        __FUNCTION__, irq, irq_list[irq].devname);
  80. return -EBUSY;
  81. }
  82. if (!(flags & IRQ_FLG_REPLACE)) {
  83. printk("%s: %s can't replace IRQ %d from %sn",
  84.        __FUNCTION__, devname, irq, irq_list[irq].devname);
  85. return -EBUSY;
  86. }
  87. }
  88. #endif
  89. irq_list[irq].handler = handler;
  90. irq_list[irq].flags   = flags;
  91. irq_list[irq].dev_id  = dev_id;
  92. irq_list[irq].devname = devname;
  93. return 0;
  94. }
  95. void sys_free_irq(unsigned int irq, void *dev_id)
  96. {
  97. if (irq < IRQ1 || irq > IRQ7) {
  98. printk("%s: Incorrect IRQ %dn", __FUNCTION__, irq);
  99. return;
  100. }
  101. if (irq_list[irq].dev_id != dev_id)
  102. printk("%s: Removing probably wrong IRQ %d from %sn",
  103.        __FUNCTION__, irq, irq_list[irq].devname);
  104. irq_list[irq].handler = (*mach_default_handler)[irq];
  105. irq_list[irq].flags   = 0;
  106. irq_list[irq].dev_id  = NULL;
  107. irq_list[irq].devname = default_names[irq];
  108. }
  109. asmlinkage void process_int(unsigned long vec, struct pt_regs *fp)
  110. {
  111. if (vec >= VEC_INT1 && vec <= VEC_INT7 && !MACH_IS_BVME6000) {
  112. vec -= VEC_SPUR;
  113. kstat.irqs[0][vec]++;
  114. irq_list[vec].handler(vec, irq_list[vec].dev_id, fp);
  115. } else {
  116. if (mach_process_int)
  117. mach_process_int(vec, fp);
  118. else
  119. panic("Can't process interrupt vector %ldn", vec);
  120. return;
  121. }
  122. }
  123. int m68k_get_irq_list(char *buf)
  124. {
  125. int i, len = 0;
  126. /* autovector interrupts */
  127. if (mach_default_handler) {
  128. for (i = 0; i < SYS_IRQS; i++) {
  129. len += sprintf(buf+len, "auto %2d: %10u ", i,
  130.                i ? kstat.irqs[0][i] : num_spurious);
  131. len += sprintf(buf+len, "  ");
  132. len += sprintf(buf+len, "%sn", irq_list[i].devname);
  133. }
  134. }
  135. len += mach_get_irq_list(buf+len);
  136. return len;
  137. }