diff options
Diffstat (limited to 'c/src/lib/libbsp/arm/tms570/clock')
-rw-r--r-- | c/src/lib/libbsp/arm/tms570/clock/benchmark_timer.c | 61 | ||||
-rw-r--r-- | c/src/lib/libbsp/arm/tms570/clock/clock.c | 4 |
2 files changed, 64 insertions, 1 deletions
diff --git a/c/src/lib/libbsp/arm/tms570/clock/benchmark_timer.c b/c/src/lib/libbsp/arm/tms570/clock/benchmark_timer.c new file mode 100644 index 0000000000..b45f0f4919 --- /dev/null +++ b/c/src/lib/libbsp/arm/tms570/clock/benchmark_timer.c @@ -0,0 +1,61 @@ +/** + * @file benchmark_timer.c + * + * @ingroup tms570 + * + * @brief clock functions definitions. + */ + +/* + * Copyright (c) 2014 Pavel Pisa <pisa@cmp.felk.cvut.cz> + * + * Czech Technical University in Prague + * Zikova 1903/4 + * 166 36 Praha 6 + * Czech Republic + * + * Based on LPC24xx and LPC1768 BSP + * by embedded brains GmbH and others + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#include <stdlib.h> + +#include <rtems.h> +#include <bsp.h> +#include <bsp/system-clocks.h> +#include <rtems/btimer.h> +#include <rtems/timerdrv.h> + +bool benchmark_timer_find_average_overhead = false; + +static uint32_t benchmark_timer_base; + +void benchmark_timer_initialize(void) +{ + benchmark_timer_base = _CPU_Counter_read(); +} + +uint32_t benchmark_timer_read(void) +{ + uint32_t delta = _CPU_Counter_read() - benchmark_timer_base; + + if (benchmark_timer_find_average_overhead) { + return delta; + } else { + /* TODO check on hardware */ + if (delta > 74) { + return delta - 74; + } else { + return 0; + } + } +} + +void benchmark_timer_disable_subtracting_average_overhead(bool find_average_overhead ) +{ + benchmark_timer_find_average_overhead = find_average_overhead; +} diff --git a/c/src/lib/libbsp/arm/tms570/clock/clock.c b/c/src/lib/libbsp/arm/tms570/clock/clock.c index 2a8bb5f4a6..4dba949c86 100644 --- a/c/src/lib/libbsp/arm/tms570/clock/clock.c +++ b/c/src/lib/libbsp/arm/tms570/clock/clock.c @@ -29,6 +29,7 @@ #include <bsp.h> #include <bsp/irq.h> #include <bsp/tms570-rti.h> +#include <rtems/counter.h> /** * holds HW counter value since last interrupt event @@ -49,6 +50,8 @@ static void tms570_clock_driver_support_initialize_hardware( void ) uint32_t microsec_per_tick = rtems_configuration_get_microseconds_per_tick(); + rtems_counter_initialize_converter(BSP_PLL_OUT_CLOCK); + /* Hardware specific initialize */ TMS570_RTI.RTIGCTRL = 0; TMS570_RTI.RTICPUC0 = BSP_PLL_OUT_CLOCK /1000000 / 2; /* prescaler */ @@ -80,7 +83,6 @@ static void tms570_clock_driver_support_at_tick( void ) { TMS570_RTI.RTIINTFLAG = 0x00000001; tms570_rti_last_tick_fcr0 = TMS570_RTI.RTICOMP0 - TMS570_RTI.RTIUDCP0; - /* TMS570_RTI.RTICOMP0 += 1000; */ } /** |