URL
https://opencores.org/ocsvn/or1k_old/or1k_old/trunk
Subversion Repositories or1k_old
[/] [or1k_old/] [trunk/] [rc203soc/] [sw/] [uClinux/] [arch/] [mips/] [kernel/] [magnum4000.S] - Rev 1782
Compare with Previous | Blame | View Log
/** arch/mips/kernel/magnum4000.S** Copyright (C) 1995 Waldorf Electronics* written by Ralf Baechle and Andreas Busse*/#include <asm/asm.h>#include <asm/mipsregs.h>#include <asm/jazz.h>#include <asm/stackframe.h>/** mips_magnum_4000_handle_int: Interrupt handler for Mips Magnum 4000*/.set noreorderNESTED(mips_magnum_4000_handle_int, FR_SIZE, ra).set noatSAVE_ALLCLI.set at/** Get pending interrupts*/mfc0 t0,CP0_CAUSE # get pending interruptsmfc0 t1,CP0_STATUS # get enabled interruptsand t0,t1 # isolate allowed onesandi t0,0xff00 # isolate pending bitsbeqz t0,spurious_interruptsll t0,16 # delay slot/** Find irq with highest priority* FIXME: This is slow*/la t1,ll_vectors1: bltz t0,2f # found pending irqsll t0,1b 1bsubu t1,PTRSIZE # delay slot/** Do the low-level stuff*/2: lw t0,(t1)jr t0nop # delay slotEND(mips_magnum_4000_handle_int)/** Used for keyboard driver's fake_keyboard_interrupt()*/ll_sw0: li s1,~IE_SW0mfc0 t0,CP0_CAUSEand t0,s1mtc0 t0,CP0_CAUSEPRINT("sw0 received...\n")li t1,1b call_realli t3,PTRSIZE # delay slot, re-map to irq level 1ll_sw1: li s1,~IE_SW1PANIC("Unimplemented sw1 handler")ll_local_dma: li s1,~IE_IRQ0PANIC("Unimplemented local_dma handler")ll_local_dev: lbu t0,JAZZ_IO_IRQ_SOURCE#if __mips == 3dsll t0,1ld t0,local_vector(t0)#else /* 32 bit */lw t0,local_vector(t0)#endifjr t0noploc_no_irq: PANIC("Unimplemented loc_no_irq handler")loc_sound: PANIC("Unimplemented loc_sound handler")loc_video: PANIC("Unimplemented loc_video handler")loc_scsi: PANIC("Unimplemented loc_scsi handler")/** Keyboard interrupt handler*/loc_keyboard: li s1,~JAZZ_IE_KEYBOARDli t1,JAZZ_KEYBOARD_IRQb loc_callli t3,PTRSIZE*JAZZ_KEYBOARD_IRQ # delay slot/** Ethernet interrupt handler, remapped to level 2*/loc_ethernet: /* PRINT ("ethernet IRQ\n"); */li s1,~JAZZ_IE_ETHERNETli t1,JAZZ_ETHERNET_IRQb loc_callli t3,PTRSIZE*JAZZ_ETHERNET_IRQ # delay slotloc_mouse: PANIC("Unimplemented loc_mouse handler")/** Serial port 1 IRQ, remapped to level 3*/loc_serial1: li s1,~JAZZ_IE_SERIAL1li t1,JAZZ_SERIAL1_IRQb loc_callli t3,PTRSIZE*JAZZ_SERIAL1_IRQ # delay slot/** Serial port 2 IRQ, remapped to level 4*/loc_serial2: li s1,~JAZZ_IE_SERIAL2li t1,JAZZ_SERIAL2_IRQb loc_callli t3,PTRSIZE*JAZZ_SERIAL2_IRQ # delay slot/** Parallel port IRQ, remapped to level 5*/loc_parallel: li s1,~JAZZ_IE_PARALLELli t1,JAZZ_PARALLEL_IRQb loc_callli t3,PTRSIZE*JAZZ_PARALLEL_IRQ # delay slot/** Floppy IRQ, remapped to level 6*/loc_floppy: li s1,~JAZZ_IE_FLOPPYli t1,JAZZ_FLOPPY_IRQb loc_callli t3,PTRSIZE*JAZZ_FLOPPY_IRQ # delay slot/** Now call the real handler*/loc_call: lui s3,%hi(intr_count)lw t2,%lo(intr_count)(s3)la t0,IRQ_vectors # delay slotaddiu t2,1sw t2,%lo(intr_count)(s3)/** Temporarily disable interrupt source*/lhu t2,JAZZ_IO_IRQ_ENABLEaddu t0,t3 # make ptr to IRQ handlerlw t0,(t0)and t2,s1 # delay slotsh t2,JAZZ_IO_IRQ_ENABLEjalr t0 # call IRQ handlernor s1,zero,s1 # delay slot/** Reenable interrupt*/lhu t2,JAZZ_IO_IRQ_ENABLElw t1,%lo(intr_count)(s3) # delay slotor t2,s1sh t2,JAZZ_IO_IRQ_ENABLEsubu t1,1jr v0sw t1,%lo(intr_count)(s3)ll_eisa_irq: li s1,~IE_IRQ2PANIC("Unimplemented eisa_irq handler")ll_eisa_nmi: li s1,~IE_IRQ3PANIC("Unimplemented eisa_nmi handler")/** Timer IRQ* We remap the timer irq to be more similar to a IBM compatible*/ll_timer: lw t0,JAZZ_TIMER_REGISTER # timer irq cleared on readli s1,~IE_IRQ4li t1,0b call_realli t3,0 # delay slot, re-map to irq level 0/** CPU count/compare IRQ (unused)*/ll_count: j returnmtc0 zero,CP0_COMPARE/** Now call the real handler*/call_real: lui s3,%hi(intr_count)lw t2,%lo(intr_count)(s3)la t0,IRQ_vectors # delay slotaddiu t2,1sw t2,%lo(intr_count)(s3)/** temporarily disable interrupt*/mfc0 t2,CP0_STATUSand t2,s1addu t0,t3lw t0,(t0)mtc0 t2,CP0_STATUS # delay slotjalr t0nor s1,zero,s1 # delay slot/** reenable interrupt*/mfc0 t2,CP0_STATUSor t2,s1mtc0 t2,CP0_STATUSlw t2,%lo(intr_count)(s3)subu t2,1jr v0sw t2,%lo(intr_count)(s3)/** Just for debugging...*/LEAF(drawline)li t1,0xffffffffli t2,0x1001: sw t1,(a0)addiu a0,a0,4addiu t2,t2,-1bnez t2,1bnopjr ranopEND(drawline).dataPTR ll_sw0 # SW0PTR ll_sw1 # SW1PTR ll_local_dma # Local DMAPTR ll_local_dev # Local devicesPTR ll_eisa_irq # EISA IRQPTR ll_eisa_nmi # EISA NMIPTR ll_timer # Timerll_vectors: PTR ll_count # Count/Compare IRQlocal_vector: PTR loc_no_irqPTR loc_parallelPTR loc_floppyPTR loc_soundPTR loc_videoPTR loc_ethernetPTR loc_scsiPTR loc_keyboardPTR loc_mousePTR loc_serial1PTR loc_serial2.align 5LEAF(spurious_interrupt)/** Nothing happened... (whistle)*/lui t1,%hi(spurious_count)lw t0,%lo(spurious_count)(t1)la v0,returnaddiu t0,1jr rasw t0,%lo(spurious_count)(t1)END(spurious_interrupt)