Subversion Repositories openrisc_me

;

;       .include "register.ah"

        .include "amd.ah"

        .include "pswmacro.ah"

        .text

;       .equ    IN,0x2000000

        .reg    CLOCK,gr78

        .reg    SECS,gr79

        .equ    CPUCLK,16

        .equ    RATE,100

        .reg    it0,gr64

        .reg    it1,gr65

        .reg    v0,gr96

timer_clear_sup:

        const   it0,IN

        consth  it0,IN

        mfsr    it1,tmr

        andn    it1,it1,it0

        mtsr    tmr,it1

        const   it0,RATE

        cplt    it0,CLOCK,it0

        jmpf    it0,carry

        add     CLOCK,CLOCK,1

        iret

carry:

        const   CLOCK,0

        add     SECS,SECS,1

        iret

        .equ    TICKS,(CPUCLK*1000000/RATE)

;       .equ    IE,0x1000000

timer_init_sup:

        const   it0,TICKS

        consth  it0,TICKS

        mtsr    tmc,it0

        const   it0,(IE|TICKS)

        consth  it0,(IE|TICKS)

        mtsr    tmr,it0

        const   SECS,0

        const   CLOCK,0

        iret

timer_get_sup:

        add     gr96,SECS,0

        iret

timer_disable_sup:

        mfsr    it0,ops

        const   it1,TD

        consth  it1,TD

        andn    it0,it1,it0

        mtsr    ops,it0

        iret

        .global _a29k_init_timer

_a29k_init_timer:

        push    msp,lr0

        const   lr2,INIT_TIMER

        consth  lr2,INIT_TIMER

        const   lr3,timer_init_sup

        consth  lr3,timer_init_sup

        const   v0,__settrap

        consth  v0,__settrap

        calli   lr0,v0

        nop

        const   lr2,CLEAR_TIMER

        consth  lr2,CLEAR_TIMER

        const   lr3,timer_clear_sup

        consth  lr3,timer_clear_sup

        const   v0,__settrap

        consth  v0,__settrap

        calli   lr0,v0

        nop

        const   lr2,DISABLE_TIMER

        consth  lr2,DISABLE_TIMER

        const   lr3,timer_disable_sup

        consth  lr3,timer_disable_sup

        const   v0,__settrap

        consth  v0,__settrap

        calli   lr0,v0

        nop

        const   lr2,GET_TIMER

        consth  lr2,GET_TIMER

        const   lr3,timer_get_sup

        consth  lr3,timer_get_sup

        const   v0,__settrap

        consth  v0,__settrap

        calli   lr0,v0

        nop

        asneq   INIT_TIMER,gr1,gr1

        pop     lr0,msp

        jmpi    lr0

        nop

        .global _a29k_clear_timer

_a29k_clear_timer:

;       asneq   CLEAR_TIMER,gr1,gr1

        jmpi lr0

        nop

        .global _a29k_disable_timer

_a29k_disable_timer:

        asneq   DISABLE_TIMER,gr1,gr1

        jmpi lr0

        nop

        .global _a29k_get_timer

_a29k_get_timer:

        asneq   GET_TIMER,gr1,gr1

        jmpi lr0

        nop