Ralf Baechle | 0711962 | 2005-09-03 15:56:11 -0700 | [diff] [blame] | 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 | extern asmlinkage void qemu_handle_int(void); |
| 11 | |
| 12 | asmlinkage void do_qemu_int(struct pt_regs *regs) |
| 13 | { |
| 14 | unsigned int pending = read_c0_status() & read_c0_cause(); |
| 15 | |
| 16 | if (pending & 0x8000) { |
| 17 | ll_timer_interrupt(Q_COUNT_COMPARE_IRQ, regs); |
| 18 | return; |
| 19 | } |
| 20 | if (pending & 0x0400) { |
| 21 | int irq = i8259_irq(); |
| 22 | |
| 23 | if (likely(irq >= 0)) |
| 24 | do_IRQ(irq, regs); |
| 25 | |
| 26 | return; |
| 27 | } |
| 28 | } |
| 29 | |
| 30 | void __init arch_init_irq(void) |
| 31 | { |
| 32 | set_except_vector(0, qemu_handle_int); |
| 33 | mips_hpt_frequency = QEMU_C0_COUNTER_CLOCK; /* 100MHz */ |
| 34 | |
| 35 | init_i8259_irqs(); |
| 36 | set_c0_status(0x8400); |
| 37 | } |