sun3ints.c 2.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100
  1. /*
  2. * linux/arch/m68k/sun3/sun3ints.c -- Sun-3(x) Linux interrupt handling code
  3. *
  4. * This file is subject to the terms and conditions of the GNU General Public
  5. * License. See the file COPYING in the main directory of this archive
  6. * for more details.
  7. */
  8. #include <linux/types.h>
  9. #include <linux/kernel.h>
  10. #include <linux/sched.h>
  11. #include <linux/kernel_stat.h>
  12. #include <linux/interrupt.h>
  13. #include <asm/intersil.h>
  14. #include <asm/oplib.h>
  15. #include <asm/sun3ints.h>
  16. #include <asm/irq_regs.h>
  17. #include <linux/seq_file.h>
  18. extern void sun3_leds (unsigned char);
  19. void sun3_disable_interrupts(void)
  20. {
  21. sun3_disable_irq(0);
  22. }
  23. void sun3_enable_interrupts(void)
  24. {
  25. sun3_enable_irq(0);
  26. }
  27. static int led_pattern[8] = {
  28. ~(0x80), ~(0x01),
  29. ~(0x40), ~(0x02),
  30. ~(0x20), ~(0x04),
  31. ~(0x10), ~(0x08)
  32. };
  33. volatile unsigned char* sun3_intreg;
  34. void sun3_enable_irq(unsigned int irq)
  35. {
  36. *sun3_intreg |= (1 << irq);
  37. }
  38. void sun3_disable_irq(unsigned int irq)
  39. {
  40. *sun3_intreg &= ~(1 << irq);
  41. }
  42. static irqreturn_t sun3_int7(int irq, void *dev_id)
  43. {
  44. unsigned int cnt;
  45. cnt = kstat_irqs_cpu(irq, 0);
  46. if (!(cnt % 2000))
  47. sun3_leds(led_pattern[cnt % 16000 / 2000]);
  48. return IRQ_HANDLED;
  49. }
  50. static irqreturn_t sun3_int5(int irq, void *dev_id)
  51. {
  52. unsigned long flags;
  53. unsigned int cnt;
  54. local_irq_save(flags);
  55. #ifdef CONFIG_SUN3
  56. intersil_clear();
  57. #endif
  58. sun3_disable_irq(5);
  59. sun3_enable_irq(5);
  60. #ifdef CONFIG_SUN3
  61. intersil_clear();
  62. #endif
  63. legacy_timer_tick(1);
  64. cnt = kstat_irqs_cpu(irq, 0);
  65. if (!(cnt % 20))
  66. sun3_leds(led_pattern[cnt % 160 / 20]);
  67. local_irq_restore(flags);
  68. return IRQ_HANDLED;
  69. }
  70. static irqreturn_t sun3_vec255(int irq, void *dev_id)
  71. {
  72. return IRQ_HANDLED;
  73. }
  74. void __init sun3_init_IRQ(void)
  75. {
  76. *sun3_intreg = 1;
  77. m68k_setup_user_interrupt(VEC_USER, 128);
  78. if (request_irq(IRQ_AUTO_5, sun3_int5, 0, "clock", NULL))
  79. pr_err("Couldn't register %s interrupt\n", "int5");
  80. if (request_irq(IRQ_AUTO_7, sun3_int7, 0, "nmi", NULL))
  81. pr_err("Couldn't register %s interrupt\n", "int7");
  82. if (request_irq(IRQ_USER+127, sun3_vec255, 0, "vec255", NULL))
  83. pr_err("Couldn't register %s interrupt\n", "vec255");
  84. }