From 267cd61c1914bc1d71f47f020d391c2d3ac1c224 Mon Sep 17 00:00:00 2001
From: gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4>
Date: Sat, 11 Feb 2012 08:57:22 +0000
Subject: Fixed bug 3485500.

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@3950 35acf78f-673a-0410-8e92-d51de3d6d3f4
---
 os/hal/src/hal.c | 71 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 71 insertions(+)

(limited to 'os/hal/src')

diff --git a/os/hal/src/hal.c b/os/hal/src/hal.c
index 3cf15226a..dad579ad0 100644
--- a/os/hal/src/hal.c
+++ b/os/hal/src/hal.c
@@ -120,4 +120,75 @@ void halInit(void) {
   boardInit();
 }
 
+#if HAL_IMPLEMENTS_COUNTERS || defined(__DOXYGEN__)
+/**
+ * @brief   Realtime window test.
+ * @details This function verifies if the current realtime counter value
+ *          lies within the specified range or not. The test takes care
+ *          of the realtime counter wrapping to zero on overflow.
+ * @note    When start==end then the function returns always true because the
+ *          whole time range is specified.
+ * @note    This is an optional service that could not be implemented in
+ *          all HAL implementations.
+ * @note    This function can be called from any context.
+ *
+ * @par Example 1
+ * Example of a guarded loop using the realtime counter. The loop implements
+ * a timeout after one second.
+ * @code
+ *   halrtcnt_t start = halGetCounterValue();
+ *   halrtcnt_t timeout  = start + S2RTT(1);
+ *   while (my_condition) {
+ *     if (!halIsCounterWithin(start, timeout)
+ *       return TIMEOUT;
+ *     // Do something.
+ *   }
+ *   // Continue.
+ * @endcode
+ *
+ * @par Example 2
+ * Example of a loop that lasts exactly 50 microseconds.
+ * @code
+ *   halrtcnt_t start = halGetCounterValue();
+ *   halrtcnt_t timeout  = start + US2RTT(50);
+ *   while (halIsCounterWithin(start, timeout)) {
+ *     // Do something.
+ *   }
+ *   // Continue.
+ * @endcode
+ *
+ * @param[in] start     the start of the time window (inclusive)
+ * @param[in] end       the end of the time window (non inclusive)
+ * @retval TRUE         current time within the specified time window.
+ * @retval FALSE        current time not within the specified time window.
+ *
+ * @special
+ */
+bool_t halIsCounterWithin(halrtcnt_t start, halrtcnt_t end) {
+  halrtcnt_t now = halGetCounterValue();
+
+  return end > start ? (now >= start) && (now < end) :
+                       (now >= start) || (now < end);
+}
+
+/**
+ * @brief   Polled delay.
+ * @note    The real delays is always few cycles in excess of the specified
+ *          value.
+ * @note    This is an optional service that could not be implemented in
+ *          all HAL implementations.
+ * @note    This function can be called from any context.
+ *
+ * @param[in] ticks     number of ticks
+ *
+ * @special
+ */
+void halPolledDelay(halrtcnt_t ticks) {
+  halrtcnt_t start = halGetCounterValue();
+  halrtcnt_t timeout  = start + (ticks);
+  while (halIsCounterWithin(start, timeout))
+    ;
+}
+#endif /* HAL_IMPLEMENTS_COUNTERS */
+
 /** @} */
-- 
cgit v1.2.3