release/src-rt-6.x/linux/linux-2.6/arch/mips/qemu/q-irq.c

   1 #include <linux/init.h>
   2 #include <linux/linkage.h>
   3
   4 #include <asm/i8259.h>
   5 #include <asm/mipsregs.h>
   6 #include <asm/qemu.h>
   7 #include <asm/system.h>
   8 #include <asm/time.h>
   9
  10 asmlinkage void plat_irq_dispatch(void)
  11 {
  12         unsigned int pending = read_c0_status() & read_c0_cause();
  13
  14         if (pending & 0x8000) {
  15                 ll_timer_interrupt(Q_COUNT_COMPARE_IRQ);
  16                 return;
  17         }
  18         if (pending & 0x0400) {
  19                 int irq = i8259_irq();
  20
  21                 if (likely(irq >= 0))
  22                         do_IRQ(irq);
  23
  24                 return;
  25         }
  26 }
  27
  28 void __init arch_init_irq(void)
  29 {
  30         mips_hpt_frequency = QEMU_C0_COUNTER_CLOCK;             /* 100MHz */
  31
  32         init_i8259_irqs();
  33         set_c0_status(0x8400);
  34 }