1 files changed, 47 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/m68k/uC5282/timer/timer.c b/c/src/lib/libbsp/m68k/uC5282/timer/timer.c
new file mode 100644
index 0000000000..3c76c94285
--- /dev/null
+++ b/c/src/lib/libbsp/m68k/uC5282/timer/timer.c
@@ -0,0 +1,47 @@
+/*
+ *  Timer Init
+ *
+ *  Use the last DMA timer (DTIM3) as the diagnostic timer.
+ */
+
+#include <rtems.h>
+#include <bsp.h>
+
+void
+Timer_initialize(void)
+{
+    int preScaleDivisor = get_CPU_clock_speed() / 1000000;
+    int div = MCF5282_TIMER_DTMR_CLK_DIV1;
+
+    if (preScaleDivisor > 256) {
+        preScaleDivisor /= 16;
+        div = MCF5282_TIMER_DTMR_CLK_DIV16;
+    }
+    MCF5282_TIMER3_DTMR = 0;
+    MCF5282_TIMER3_DTMR = MCF5282_TIMER_DTMR_PS(preScaleDivisor - 1) | div |
+                          MCF5282_TIMER_DTMR_RST;
+}
+
+/*
+ * Return timer value in microsecond units
+ */
+int
+Read_timer(void)
+{
+    return MCF5282_TIMER3_DTCN;
+}
+
+/*
+ *  Empty function call used in loops to measure basic cost of looping
+ *  in Timing Test Suite.
+ */
+rtems_status_code
+Empty_function(void)
+{
+    return RTEMS_SUCCESSFUL;
+}
+
+void
+Set_find_average_overhead(rtems_boolean find_flag)
+{
+}