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

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * Code to handle DECstation IRQs plus some generic interrupt stuff.
  3.  *
  4.  * Copyright (C) 1992 Linus Torvalds
  5.  * Copyright (C) 1994, 1995, 1996, 1997, 2000 Ralf Baechle
  6.  */
  7. #include <linux/errno.h>
  8. #include <linux/init.h>
  9. #include <linux/kernel_stat.h>
  10. #include <linux/signal.h>
  11. #include <linux/sched.h>
  12. #include <linux/types.h>
  13. #include <linux/interrupt.h>
  14. #include <linux/ioport.h>
  15. #include <linux/timex.h>
  16. #include <linux/slab.h>
  17. #include <linux/random.h>
  18. #include <asm/bitops.h>
  19. #include <asm/bootinfo.h>
  20. #include <asm/io.h>
  21. #include <asm/irq.h>
  22. #include <asm/mipsregs.h>
  23. #include <asm/system.h>
  24. #include <asm/dec/interrupts.h>
  25. extern void dec_init_kn01(void);
  26. extern void dec_init_kn230(void);
  27. extern void dec_init_kn02(void);
  28. extern void dec_init_kn02ba(void);
  29. extern void dec_init_kn02ca(void);
  30. extern void dec_init_kn03(void);
  31. extern asmlinkage void decstation_handle_int(void);
  32. unsigned long spurious_count = 0;
  33. static inline void mask_irq(unsigned int irq_nr)
  34. {
  35.     unsigned int dummy;
  36.     if (dec_interrupt[irq_nr].iemask) { /* This is an ASIC interrupt    */
  37. *imr &= ~dec_interrupt[irq_nr].iemask;
  38. dummy = *imr;
  39. dummy = *imr;
  40.     } else /* This is a cpu interrupt        */
  41. change_cp0_status(ST0_IM, read_32bit_cp0_register(CP0_STATUS) & ~dec_interrupt[irq_nr].cpu_mask);
  42. }
  43. static inline void unmask_irq(unsigned int irq_nr)
  44. {
  45.     unsigned int dummy;
  46.     if (dec_interrupt[irq_nr].iemask) { /* This is an ASIC interrupt    */
  47. *imr |= dec_interrupt[irq_nr].iemask;
  48. dummy = *imr;
  49. dummy = *imr;
  50.     }
  51.     change_cp0_status(ST0_IM, read_32bit_cp0_register(CP0_STATUS) | dec_interrupt[irq_nr].cpu_mask);
  52. }
  53. void disable_irq(unsigned int irq_nr)
  54. {
  55.     unsigned long flags;
  56.     save_and_cli(flags);
  57.     mask_irq(irq_nr);
  58.     restore_flags(flags);
  59. }
  60. void enable_irq(unsigned int irq_nr)
  61. {
  62.     unsigned long flags;
  63.     save_and_cli(flags);
  64.     unmask_irq(irq_nr);
  65.     restore_flags(flags);
  66. }
  67. /*
  68.  * Pointers to the low-level handlers: first the general ones, then the
  69.  * fast ones, then the bad ones.
  70.  */
  71. extern void interrupt(void);
  72. static struct irqaction *irq_action[32] =
  73. {
  74.     NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL,
  75.     NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL,
  76.     NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL,
  77.     NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL
  78. };
  79. int get_irq_list(char *buf)
  80. {
  81.     int i, len = 0;
  82.     struct irqaction *action;
  83.     for (i = 0; i < 32; i++) {
  84. action = irq_action[i];
  85. if (!action)
  86.     continue;
  87. len += sprintf(buf + len, "%2d: %8d %c %s",
  88.        i, kstat.irqs[0][i],
  89.        (action->flags & SA_INTERRUPT) ? '+' : ' ',
  90.        action->name);
  91. for (action = action->next; action; action = action->next) {
  92.     len += sprintf(buf + len, ",%s %s",
  93.    (action->flags & SA_INTERRUPT) ? " +" : "",
  94.    action->name);
  95. }
  96. len += sprintf(buf + len, "n");
  97.     }
  98.     return len;
  99. }
  100. /*
  101.  * do_IRQ handles IRQ's that have been installed without the
  102.  * SA_INTERRUPT flag: it uses the full signal-handling return
  103.  * and runs with other interrupts enabled. All relatively slow
  104.  * IRQ's should use this format: notably the keyboard/timer
  105.  * routines.
  106.  */
  107. asmlinkage void do_IRQ(int irq, struct pt_regs *regs)
  108. {
  109.     struct irqaction *action;
  110.     int do_random, cpu;
  111.     cpu = smp_processor_id();
  112.     irq_enter(cpu, irq);
  113.     kstat.irqs[cpu][irq]++;
  114.     mask_irq(irq);
  115.     action = *(irq + irq_action);
  116.     if (action) {
  117. if (!(action->flags & SA_INTERRUPT))
  118.     __sti();
  119. action = *(irq + irq_action);
  120. do_random = 0;
  121. do {
  122.     do_random |= action->flags;
  123.     action->handler(irq, action->dev_id, regs);
  124.     action = action->next;
  125. } while (action);
  126. if (do_random & SA_SAMPLE_RANDOM)
  127.     add_interrupt_randomness(irq);
  128. __cli();
  129. unmask_irq(irq);
  130.     }
  131.     irq_exit(cpu, irq);
  132.     /* unmasking and bottom half handling is done magically for us. */
  133. }
  134. /*
  135.  * Idea is to put all interrupts
  136.  * in a single table and differenciate them just by number.
  137.  */
  138. int setup_dec_irq(int irq, struct irqaction *new)
  139. {
  140.     int shared = 0;
  141.     struct irqaction *old, **p;
  142.     unsigned long flags;
  143.     p = irq_action + irq;
  144.     if ((old = *p) != NULL) {
  145. /* Can't share interrupts unless both agree to */
  146. if (!(old->flags & new->flags & SA_SHIRQ))
  147.     return -EBUSY;
  148. /* Can't share interrupts unless both are same type */
  149. if ((old->flags ^ new->flags) & SA_INTERRUPT)
  150.     return -EBUSY;
  151. /* add new interrupt at end of irq queue */
  152. do {
  153.     p = &old->next;
  154.     old = *p;
  155. } while (old);
  156. shared = 1;
  157.     }
  158.     if (new->flags & SA_SAMPLE_RANDOM)
  159. rand_initialize_irq(irq);
  160.     save_and_cli(flags);
  161.     *p = new;
  162.     if (!shared) {
  163. unmask_irq(irq);
  164.     }
  165.     restore_flags(flags);
  166.     return 0;
  167. }
  168. int request_irq(unsigned int irq,
  169. void (*handler) (int, void *, struct pt_regs *),
  170. unsigned long irqflags,
  171. const char *devname,
  172. void *dev_id)
  173. {
  174.     int retval;
  175.     struct irqaction *action;
  176.     if (irq >= 32)
  177. return -EINVAL;
  178.     if (!handler)
  179. return -EINVAL;
  180.     action = (struct irqaction *) kmalloc(sizeof(struct irqaction), GFP_KERNEL);
  181.     if (!action)
  182. return -ENOMEM;
  183.     action->handler = handler;
  184.     action->flags = irqflags;
  185.     action->mask = 0;
  186.     action->name = devname;
  187.     action->next = NULL;
  188.     action->dev_id = dev_id;
  189.     retval = setup_dec_irq(irq, action);
  190.     if (retval)
  191. kfree(action);
  192.     return retval;
  193. }
  194. void free_irq(unsigned int irq, void *dev_id)
  195. {
  196.     struct irqaction *action, **p;
  197.     unsigned long flags;
  198.     if (irq > 39) {
  199. printk("Trying to free IRQ%dn", irq);
  200. return;
  201.     }
  202.     for (p = irq + irq_action; (action = *p) != NULL; p = &action->next) {
  203. if (action->dev_id != dev_id)
  204.     continue;
  205. /* Found it - now free it */
  206. save_and_cli(flags);
  207. *p = action->next;
  208. if (!irq[irq_action])
  209.     mask_irq(irq);
  210. restore_flags(flags);
  211. kfree(action);
  212. return;
  213.     }
  214.     printk("Trying to free free IRQ%dn", irq);
  215. }
  216. unsigned long probe_irq_on(void)
  217. {
  218.     /* TODO */
  219.     return 0;
  220. }
  221. int probe_irq_off(unsigned long irqs)
  222. {
  223.     /* TODO */
  224.     return 0;
  225. }
  226. void __init init_IRQ(void)
  227. {
  228.     switch (mips_machtype) {
  229.     case MACH_DS23100:
  230. dec_init_kn01();
  231. break;
  232.     case MACH_DS5100: /*  DS5100 MIPSMATE */
  233. dec_init_kn230();
  234. break;
  235.     case MACH_DS5000_200: /* DS5000 3max */
  236. dec_init_kn02();
  237. break;
  238.     case MACH_DS5000_1XX: /* DS5000/100 3min */
  239. dec_init_kn02ba();
  240. break;
  241.     case MACH_DS5000_2X0: /* DS5000/240 3max+ */
  242. dec_init_kn03();
  243. break;
  244.     case MACH_DS5000_XX: /* Personal DS5000/2x */
  245. dec_init_kn02ca();
  246. break;
  247.     case MACH_DS5800: /* DS5800 Isis */
  248. panic("Don't know how to set this up!");
  249. break;
  250.     case MACH_DS5400: /* DS5400 MIPSfair */
  251. panic("Don't know how to set this up!");
  252. break;
  253.     case MACH_DS5500: /* DS5500 MIPSfair-2 */
  254. panic("Don't know how to set this up!");
  255. break;
  256.     }
  257.     set_except_vector(0, decstation_handle_int);
  258. }