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

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * arch/m68k/mvme16x/16xints.c
  3.  *
  4.  * Copyright (C) 1995 Richard Hirst [richard@sleepie.demon.co.uk]
  5.  *
  6.  * based on amiints.c -- Amiga Linux interrupt handling code
  7.  *
  8.  * This file is subject to the terms and conditions of the GNU General Public
  9.  * License.  See the file README.legal in the main directory of this archive
  10.  * for more details.
  11.  *
  12.  */
  13. #include <linux/types.h>
  14. #include <linux/kernel.h>
  15. #include <linux/errno.h>
  16. #include <asm/system.h>
  17. #include <asm/ptrace.h>
  18. #include <asm/irq.h>
  19. static void mvme16x_defhand (int irq, void *dev_id, struct pt_regs *fp);
  20. /*
  21.  * This should ideally be 4 elements only, for speed.
  22.  */
  23. static struct {
  24. void (*handler)(int, void *, struct pt_regs *);
  25. unsigned long flags;
  26. void *dev_id;
  27. const char *devname;
  28. unsigned count;
  29. } irq_tab[192];
  30. /*
  31.  * void mvme16x_init_IRQ (void)
  32.  *
  33.  * Parameters: None
  34.  *
  35.  * Returns: Nothing
  36.  *
  37.  * This function is called during kernel startup to initialize
  38.  * the mvme16x IRQ handling routines.  Should probably ensure
  39.  * that the base vectors for the VMEChip2 and PCCChip2 are valid.
  40.  */
  41. void mvme16x_init_IRQ (void)
  42. {
  43. int i;
  44. for (i = 0; i < 192; i++) {
  45. irq_tab[i].handler = mvme16x_defhand;
  46. irq_tab[i].flags = IRQ_FLG_STD;
  47. irq_tab[i].dev_id = NULL;
  48. irq_tab[i].devname = NULL;
  49. irq_tab[i].count = 0;
  50. }
  51. }
  52. int mvme16x_request_irq(unsigned int irq,
  53. void (*handler)(int, void *, struct pt_regs *),
  54.                 unsigned long flags, const char *devname, void *dev_id)
  55. {
  56. if (irq < 64 || irq > 255) {
  57. printk("%s: Incorrect IRQ %d from %sn", __FUNCTION__, irq, devname);
  58. return -ENXIO;
  59. }
  60. if (!(irq_tab[irq-64].flags & IRQ_FLG_STD)) {
  61. if (irq_tab[irq-64].flags & IRQ_FLG_LOCK) {
  62. printk("%s: IRQ %d from %s is not replaceablen",
  63.        __FUNCTION__, irq, irq_tab[irq-64].devname);
  64. return -EBUSY;
  65. }
  66. if (flags & IRQ_FLG_REPLACE) {
  67. printk("%s: %s can't replace IRQ %d from %sn",
  68.        __FUNCTION__, devname, irq, irq_tab[irq-64].devname);
  69. return -EBUSY;
  70. }
  71. }
  72. irq_tab[irq-64].handler = handler;
  73. irq_tab[irq-64].flags   = flags;
  74. irq_tab[irq-64].dev_id  = dev_id;
  75. irq_tab[irq-64].devname = devname;
  76. return 0;
  77. }
  78. void mvme16x_free_irq(unsigned int irq, void *dev_id)
  79. {
  80. if (irq < 64 || irq > 255) {
  81. printk("%s: Incorrect IRQ %dn", __FUNCTION__, irq);
  82. return;
  83. }
  84. if (irq_tab[irq-64].dev_id != dev_id)
  85. printk("%s: Removing probably wrong IRQ %d from %sn",
  86.        __FUNCTION__, irq, irq_tab[irq-64].devname);
  87. irq_tab[irq-64].handler = mvme16x_defhand;;
  88. irq_tab[irq-64].flags   = IRQ_FLG_STD;
  89. irq_tab[irq-64].dev_id  = NULL;
  90. irq_tab[irq-64].devname = NULL;
  91. }
  92. void mvme16x_process_int (unsigned long vec, struct pt_regs *fp)
  93. {
  94. if (vec < 64 || vec > 255)
  95. printk ("mvme16x_process_int: Illegal vector %ld", vec);
  96. else
  97. {
  98. irq_tab[vec-64].count++;
  99. irq_tab[vec-64].handler(vec, irq_tab[vec-64].dev_id, fp);
  100. }
  101. }
  102. int mvme16x_get_irq_list (char *buf)
  103. {
  104. int i, len = 0;
  105. for (i = 0; i < 192; i++) {
  106. if (irq_tab[i].count)
  107. len += sprintf (buf+len, "Vec 0x%02x: %8d  %sn",
  108.     i+64, irq_tab[i].count,
  109.     irq_tab[i].devname ? irq_tab[i].devname : "free");
  110. }
  111. return len;
  112. }
  113. static void mvme16x_defhand (int irq, void *dev_id, struct pt_regs *fp)
  114. {
  115. printk ("Unknown interrupt 0x%02xn", irq);
  116. }
  117. void mvme16x_enable_irq (unsigned int irq)
  118. {
  119. }
  120. void mvme16x_disable_irq (unsigned int irq)
  121. {
  122. }