diff --git a/lib/Math.cpp b/lib/Math.cpp
index 6658c3b..4320f7e 100644
--- a/lib/Math.cpp
+++ b/lib/Math.cpp
@@ -24,6 +24,19 @@
 using namespace std;
 using namespace Latan;
 
+/******************************************************************************
+ *                             Custom math functions                          *
+ ******************************************************************************/
+DMat MATH_NAMESPACE::varToCorr(const DMat &var)
+{
+    DMat res = var, invDiag = res.diagonal();
+    
+    invDiag = invDiag.cwiseInverse().cwiseSqrt();
+    res     = (invDiag*invDiag.transpose()).cwiseProduct(res);
+    
+    return res;
+}
+
 /******************************************************************************
  *                             Standard C functions                           *
  ******************************************************************************/
diff --git a/lib/Math.hpp b/lib/Math.hpp
index 7f7f018..a54f82f 100644
--- a/lib/Math.hpp
+++ b/lib/Math.hpp
@@ -68,6 +68,9 @@ namespace MATH_NAMESPACE
         return res;
     }
     
+    // convert variance matrix to correlation matrix
+    DMat varToCorr(const DMat &var);
+    
     // Constants
     const double pi = 3.1415926535897932384626433832795028841970;
     const double e  = 2.7182818284590452353602874713526624977572;