include/util: added within_range() function

dc8f438c · Tomasz Wlostowski · 5fa3aea0 · dc8f438c
Commit dc8f438c authored Mar 20, 2020 by Tomasz Wlostowski
Hide whitespace changes
Inline Side-by-side

Showing with 33 additions and 0 deletions

util.h include/util.h +33 -0

No files found.
--- a/include/util.h
+++ b/include/util.h
@@ -43,4 +43,37 @@ int tmo_init(timeout_t *tmo, uint32_t milliseconds);
 int tmo_restart(timeout_t *tmo);
 int tmo_expired(timeout_t *tmo);

+static inline int within_range(int x, int minval, int maxval, int wrap)
+{
+    int rv;
+
+    //printf("min %d max %d x %d ", minval, maxval, x);
+
+    while (maxval >= wrap)
+        maxval -= wrap;
+
+    while (maxval < 0)
+        maxval += wrap;
+
+    while (minval >= wrap)
+        minval -= wrap;
+
+    while (minval < 0)
+        minval += wrap;
+
+    while (x < 0)
+        x += wrap;
+
+    while (x >= wrap)
+        x -= wrap;
+
+    if (maxval > minval)
+        rv = (x >= minval && x <= maxval) ? 1 : 0;
+    else
+        rv = (x >= minval || x <= maxval) ? 1 : 0;
+
+    return rv;
+}
+
+
 #endif