diff --git a/matrix/helper_functions.hpp b/matrix/helper_functions.hpp
index db23bc576a..284644657a 100644
--- a/matrix/helper_functions.hpp
+++ b/matrix/helper_functions.hpp
@@ -10,7 +10,7 @@ namespace matrix
 template<typename Type>
 Type wrap_pi(Type x)
 {
-    if (!isfinite(float(x))) {
+    if (!isfinite(Type(x))) {
         return x;
     }