From 7041c5b167918def8ad906cbd9a46d73acc73c56 Mon Sep 17 00:00:00 2001
From: gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4>
Date: Mon, 9 Jan 2012 18:28:29 +0000
Subject: git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@3775
 35acf78f-673a-0410-8e92-d51de3d6d3f4

---
 os/hal/src/hal.c |   3 ++
 os/hal/src/tm.c  | 105 +++++++++++++++++++++++++++++++++++++++++++++++++++++++
 2 files changed, 108 insertions(+)
 create mode 100644 os/hal/src/tm.c

(limited to 'os/hal/src')

diff --git a/os/hal/src/hal.c b/os/hal/src/hal.c
index d5a8082e9..b469b57e5 100644
--- a/os/hal/src/hal.c
+++ b/os/hal/src/hal.c
@@ -62,6 +62,9 @@ void halInit(void) {
 
   hal_lld_init();
 
+#if HAL_USE_TM || defined(__DOXYGEN__)
+  tmInit();
+#endif
 #if HAL_USE_PAL || defined(__DOXYGEN__)
   palInit(&pal_default_config);
 #endif
diff --git a/os/hal/src/tm.c b/os/hal/src/tm.c
new file mode 100644
index 000000000..4d1eb57b8
--- /dev/null
+++ b/os/hal/src/tm.c
@@ -0,0 +1,105 @@
+/*
+    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
+                 2011 Giovanni Di Sirio.
+
+    This file is part of ChibiOS/RT.
+
+    ChibiOS/RT is free software; you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation; either version 3 of the License, or
+    (at your option) any later version.
+
+    ChibiOS/RT is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with this program.  If not, see <http://www.gnu.org/licenses/>.
+*/
+
+/**
+ * @file    tm.c
+ * @brief   Time Measurement unit code.
+ *
+ * @addtogroup TM
+ * @{
+ */
+
+#include "ch.h"
+#include "hal.h"
+
+#if HAL_USE_TM
+
+/**
+ * @brief   Subsystem calibration value.
+ */
+static halrtcnt_t measurement_offset;
+
+
+/**
+ * @brief   Starts a measurement.
+ *
+ * @param[in,out] tmp   pointer to a @p TimeMeasurement structure
+ *
+ * @notapi
+ */
+static void tm_start(TimeMeasurement *tmp) {
+
+  tmp->last = halGetCounterValue();
+}
+
+/**
+ * @brief   Stops a measurement.
+ *
+ * @param[in,out] tmp   pointer to a @p TimeMeasurement structure
+ *
+ * @notapi
+ */
+static void tm_stop(TimeMeasurement *tmp) {
+
+  halrtcnt_t now = halGetCounterValue();
+  tmp->last = now - tmp->last - measurement_offset;
+  if (tmp->last > tmp->worst)
+      tmp->worst = tmp->last;
+  else if (tmp->last < tmp->best)
+      tmp->best = tmp->last;
+}
+
+/**
+ * @brief   Initializes the Time Measurement unit.
+ *
+ * @init
+ */
+void tmInit(void) {
+  TimeMeasurement tm;
+
+  /* Time Measurement subsystem calibration, it does a null measurement
+     and calculates the call overhead which is subtracted to real
+     measurements.*/
+  measurement_offset = 0;
+  tmObjectInit(&tm);
+  tmStartMeasurement(&tm);
+  tmStopMeasurement(&tm);
+  measurement_offset = tm.last;
+}
+
+/**
+ * @brief   Initializes a @p TimeMeasurement object.
+ *
+ * @param[out] tmp      pointer to a @p TimeMeasurement structure
+ *
+ * @init
+ */
+void tmObjectInit(TimeMeasurement *tmp) {
+
+  tmp->start = tm_start;
+  tmp->stop  = tm_stop;
+  tmp->last  = (halrtcnt_t)0;
+  tmp->worst = (halrtcnt_t)0;
+  tmp->best  = (halrtcnt_t)-1;
+}
+
+#endif /* HAL_USE_TM */
+
+/** @} */
-- 
cgit v1.2.3