Added CUBES!

source/math_helper.cpp

@@ -31,4 +31,42 @@ bool double_equal(double a, double b)
 double deg_to_rad(double deg)
 {
    return deg * M_PI / 180.;
+}
+
+double min3(double a, double b, double c)
+{
+    if (a <= b)
+    {
+        if (c < a) return c;
+        return a;
+    }
+    if (b <= a)
+    {
+        if (c < b) return c;
+        return b;
+    }
+    if (c <= a)
+    {
+        if (b < c) return b;
+    }
+    return c;
+}
+
+double max3(double a, double b, double c)
+{
+    if (a >= b)
+    {
+        if (c > a) return c;
+        return a;
+    }
+    if (b >= a)
+    {
+        if (c > b) return c;
+        return b;
+    }
+    if (c >= a)
+    {
+        if (b > c) return b;
+    }
+    return c;
 }