diff options
Diffstat (limited to 'c/src/lib/libbsp/mips/jmr3904/clock/clockdrv.c')
| -rw-r--r-- | c/src/lib/libbsp/mips/jmr3904/clock/clockdrv.c | 18 |
1 files changed, 16 insertions, 2 deletions
diff --git a/c/src/lib/libbsp/mips/jmr3904/clock/clockdrv.c b/c/src/lib/libbsp/mips/jmr3904/clock/clockdrv.c index c49150fba6..7436f1676a 100644 --- a/c/src/lib/libbsp/mips/jmr3904/clock/clockdrv.c +++ b/c/src/lib/libbsp/mips/jmr3904/clock/clockdrv.c @@ -7,12 +7,26 @@ * $Id$ */ -#define CLOCK_VECTOR 0 +#include <rtems.h> +#include <libcpu/tx3904.h> + +#define CLOCK_VECTOR TX3904_IRQ_TMR0 #define Clock_driver_support_at_tick() +/* XXX */ +#define CLICKS 10000 #define Clock_driver_support_install_isr( _new, _old ) \ - do { _old = 0; } while(0) + do { \ + unsigned32 _clicks = CLICKS; \ + _old = (rtems_isr_entry) set_vector( _new, CLOCK_VECTOR, 1 ); \ + TX3904_TIMER_WRITE( TX3904_TIMER0_BASE, TX3904_TIMER_CCDR, 0x3 ); \ + TX3904_TIMER_WRITE( TX3904_TIMER0_BASE, TX3904_TIMER_CPRA, _clicks ); \ + TX3904_TIMER_WRITE( TX3904_TIMER0_BASE, TX3904_TIMER_TISR, 0x00 ); \ + TX3904_TIMER_WRITE( TX3904_TIMER0_BASE, TX3904_TIMER_ITMR, 0x8001 ); \ + TX3904_TIMER_WRITE( TX3904_TIMER0_BASE, TX3904_TIMER_TCR, 0xC0 ); \ + *((volatile unsigned32 *) 0xFFFFC01C) = 0x00000700; \ + } while(0) #define Clock_driver_support_initialize_hardware() |