1 files changed, 48 insertions, 0 deletions
diff --git a/bsps/arm/raspberrypi/start/timer.c b/bsps/arm/raspberrypi/start/timer.c
new file mode 100644
index 0000000000..f52ecb3a26
--- /dev/null
+++ b/bsps/arm/raspberrypi/start/timer.c
@@ -0,0 +1,48 @@
+/**
+ * @file
+ *
+ * @ingroup raspberrypi
+ *
+ * @brief Benchmark timer support.
+ */
+
+/*
+ * Copyright (c) 2013 by Alan Cudmore
+ *
+ *  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 <bsp.h>
+#include <rtems.h>
+#include <rtems/btimer.h>
+#include <bsp/raspberrypi.h>
+
+static bool benchmark_timer_find_average_overhead = false;
+
+static uint64_t benchmark_timer_base;
+
+void benchmark_timer_initialize( void )
+{
+  benchmark_timer_base = BCM2835_REG( BCM2835_GPU_TIMER_CLO );
+}
+
+benchmark_timer_t benchmark_timer_read( void )
+{
+  uint32_t delta = BCM2835_REG( BCM2835_GPU_TIMER_CLO ) - benchmark_timer_base;
+
+  if ( benchmark_timer_find_average_overhead ) {
+    return delta;
+  } else {
+    return BCM2835_REG( BCM2835_GPU_TIMER_CLO );
+  }
+}
+
+void benchmark_timer_disable_subtracting_average_overhead(
+  bool find_average_overhead )
+{
+  benchmark_timer_find_average_overhead = find_average_overhead;
+}