[#17] : Added clamp function

ange-yaghi · Jul 13, 2020 · 667c060 · 667c060
1 parent 87ac1b0
commit 667c060
Show file tree

Hide file tree

Showing 2 changed files with 8 additions and 0 deletions.
diff --git a/include/yds_math.h b/include/yds_math.h
@@ -273,6 +273,7 @@ namespace ysMath {
 
     ysVector ComponentMax(const ysVector &a, const ysVector &b);
     ysVector ComponentMin(const ysVector &a, const ysVector &b);
+    ysVector Clamp(const ysVector &a, const ysVector &r_min, const ysVector &r_max);
 
     ysVector MaxComponent(const ysVector &v);
 

diff --git a/src/yds_math.cpp b/src/yds_math.cpp
@@ -825,6 +825,13 @@ ysVector ysMath::ComponentMin(const ysVector &a, const ysVector &b) {
     return result;
 }
 
+ysVector ysMath::Clamp(const ysVector &a, const ysVector &r_min, const ysVector &r_max) {
+    return ComponentMax(
+        ComponentMin(a, r_max),
+        r_min
+    );
+}
+
 ysVector ysMath::MaxComponent(const ysVector &v) {
     // y, x, w, z
     ysVector r1 = _mm_shuffle_ps(v, v, _MM_SHUFFLE(2, 3, 0, 1));