diff options
| author | Hesham ALMatary <heshamelmatary@gmail.com> | 2014-09-15 17:33:31 -0500 |
|---|---|---|
| committer | Joel Sherrill <joel.sherrill@oarcorp.com> | 2014-09-16 09:53:05 -0500 |
| commit | d2c76160578076e6d64156e7fd6820aae16b0294 (patch) | |
| tree | 07209e8949832c9721cdbe8e2d5132e771cad4ea | |
| parent | score/cpu/or1k: Follow no_cpu ISR_Handler algorithm. (diff) | |
| download | rtems-d2c76160578076e6d64156e7fd6820aae16b0294.tar.bz2 | |
or1ksim: Implement cpu counter functions.
| -rw-r--r-- | c/src/lib/libbsp/or1k/or1ksim/clock/clockdrv.c | 24 |
1 files changed, 24 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/or1k/or1ksim/clock/clockdrv.c b/c/src/lib/libbsp/or1k/or1ksim/clock/clockdrv.c index 7358bf581e..ad49d0744b 100644 --- a/c/src/lib/libbsp/or1k/or1ksim/clock/clockdrv.c +++ b/c/src/lib/libbsp/or1k/or1ksim/clock/clockdrv.c @@ -27,6 +27,9 @@ #define TTMR_NUM_OF_CLOCK_TICKS_INTERRUPT 0x09ED9 #define OR1KSIM_CLOCK_CYCLE_TIME_NANOSECONDS 10 +/* CPU counter */ +static CPU_Counter_ticks cpu_counter_ticks; + /* This prototype is added here to Avoid warnings */ void Clock_isr(void *arg); @@ -46,6 +49,8 @@ static void or1ksim_clock_at_tick(void) _OR1K_mtspr(CPU_OR1K_SPR_TTMR, TTMR); _OR1K_mtspr(CPU_OR1K_SPR_TTCR, 0); + + cpu_counter_ticks += TTMR_NUM_OF_CLOCK_TICKS_INTERRUPT; } static void or1ksim_clock_handler_install(proc_ptr new_isr, proc_ptr old_isr) @@ -81,6 +86,9 @@ static void or1ksim_clock_initialize(void) _OR1K_mtspr(CPU_OR1K_SPR_TTMR, TTMR); _OR1K_mtspr(CPU_OR1K_SPR_TTCR, 0); + + /* Initialize CPU Counter */ + cpu_counter_ticks = 0; } static void or1ksim_clock_cleanup(void) @@ -107,6 +115,22 @@ static uint32_t or1ksim_clock_nanoseconds_since_last_tick(void) TTMR_NUM_OF_CLOCK_TICKS_INTERRUPT * OR1KSIM_CLOCK_CYCLE_TIME_NANOSECONDS; } +CPU_Counter_ticks _CPU_Counter_read(void) +{ + uint32_t ticks_since_last_timer_interrupt; + + ticks_since_last_timer_interrupt = _OR1K_mfspr(CPU_OR1K_SPR_TTCR); + + return cpu_counter_ticks + ticks_since_last_timer_interrupt; +} + +CPU_Counter_ticks _CPU_Counter_difference( + CPU_Counter_ticks second, + CPU_Counter_ticks first +) +{ + return second - first; +} #define Clock_driver_support_at_tick() or1ksim_clock_at_tick() #define Clock_driver_support_initialize_hardware() or1ksim_clock_initialize() |