From ec6b2c94cd68f54af813abe785e8e80f2d8caffe Mon Sep 17 00:00:00 2001
From: Your Name <you@example.com>
Date: Mon, 3 Jun 2024 00:58:34 -0400
Subject: [PATCH] Fix compatibility of OSQP 1 when using Windows

---
 include/OsqpEigen/Compat.hpp             | 76 ++++++++++++++++++++++++
 include/OsqpEigen/SparseMatrixHelper.tpp |  2 +-
 src/Data.cpp                             |  4 +-
 tests/SparseMatrixTest.cpp               |  4 +-
 4 files changed, 81 insertions(+), 5 deletions(-)

diff --git a/include/OsqpEigen/Compat.hpp b/include/OsqpEigen/Compat.hpp
index 7556f79..c7f9f3e 100644
--- a/include/OsqpEigen/Compat.hpp
+++ b/include/OsqpEigen/Compat.hpp
@@ -11,6 +11,8 @@
 // OSQP
 #include <osqp.h>
 
+#include <cstdlib>
+
 #ifdef OSQP_EIGEN_OSQP_IS_V1
 
 // Re-use the same name in the global namespace as the old versions of OSQP
@@ -43,7 +45,81 @@ struct OSQPData
     OSQPFloat* u; ///< dense array for upper bound (size m)
 };
 
+inline OSQPCscMatrix* spalloc(OSQPInt m,
+                              OSQPInt n,
+                              OSQPInt nzmax)
+{
+    OSQPCscMatrix* M = static_cast<OSQPCscMatrix*>(calloc(1, sizeof(OSQPCscMatrix))); /* allocate the OSQPCscMatrix struct */
+    if (!M)
+    {
+        return static_cast<OSQPCscMatrix*>(OSQP_NULL);
+    }
+
+    OSQPInt* M_p = static_cast<OSQPInt*>(calloc(n + 1, sizeof(OSQPInt)));
+    if (!M_p)
+    {
+        free(M);
+        return static_cast<OSQPCscMatrix*>(OSQP_NULL);
+    }
+
+    OSQPInt* M_i = static_cast<OSQPInt*>(calloc(nzmax,  sizeof(OSQPInt)));
+    if (!M_i)
+    {
+        free(M);
+        free(M_p);
+        return static_cast<OSQPCscMatrix*>(OSQP_NULL);
+    }
+
+    OSQPFloat* M_x = static_cast<OSQPFloat*>(calloc(nzmax,  sizeof(OSQPFloat)));
+    if (!M_x)
+    {
+        free(M);
+        free(M_p);
+        free(M_i);
+        return static_cast<OSQPCscMatrix*>(OSQP_NULL);
+    }
+
+    OSQPInt M_nnz = 0;
+
+    if (nzmax >= 0)
+    {
+        M_nnz = nzmax;
+    }
+
+    csc_set_data(M, m, n, M_nnz, M_x, M_i, M_p);
+
+    return M;
+}
+
+inline void spfree(OSQPCscMatrix* M)
+{
+    if (M){
+        if (M->p) free(M->p);
+        if (M->i) free(M->i);
+        if (M->x) free(M->x);
+        free(M);
+    }
+}
+
 } // namespace OsqpEigen
 
+#else
+
+namespace OsqpEigen
+{
+
+inline csc* spalloc(c_int m, c_int n, c_int nzmax)
+{
+    return csc_spalloc(m, n, nzmax, 1, 0);
+}
+
+inline void spfree(csc* M)
+{
+    return csc_spfree(M);
+}
+
+} // namespace OsqpEigen
+
+
 #endif // OSQP_EIGEN_OSQP_IS_V1
 #endif // OSQP_EIGEN_COMPAT_HPP
diff --git a/include/OsqpEigen/SparseMatrixHelper.tpp b/include/OsqpEigen/SparseMatrixHelper.tpp
index 2d89eb5..5534c59 100644
--- a/include/OsqpEigen/SparseMatrixHelper.tpp
+++ b/include/OsqpEigen/SparseMatrixHelper.tpp
@@ -39,7 +39,7 @@ bool OsqpEigen::SparseMatrixHelper::createOsqpSparseMatrix(
         return false;
     }
 
-    osqpSparseMatrix = csc_spalloc(rows, cols, numberOfNonZeroCoeff, 1, 0);
+    osqpSparseMatrix = OsqpEigen::spalloc(rows, cols, numberOfNonZeroCoeff);
 
     int innerOsqpPosition = 0;
     for (int k = 0; k < cols; k++)
diff --git a/src/Data.cpp b/src/Data.cpp
index d9952c9..ad51e1d 100644
--- a/src/Data.cpp
+++ b/src/Data.cpp
@@ -48,7 +48,7 @@ void OsqpEigen::Data::clearHessianMatrix()
     if (m_isHessianMatrixSet)
     {
         m_isHessianMatrixSet = false;
-        csc_spfree(m_data->P);
+        OsqpEigen::spfree(m_data->P);
         m_data->P = nullptr;
     }
 }
@@ -58,7 +58,7 @@ void OsqpEigen::Data::clearLinearConstraintsMatrix()
     if (m_isLinearConstraintsMatrixSet)
     {
         m_isLinearConstraintsMatrixSet = false;
-        csc_spfree(m_data->A);
+        OsqpEigen::spfree(m_data->A);
         m_data->A = nullptr;
     }
 }
diff --git a/tests/SparseMatrixTest.cpp b/tests/SparseMatrixTest.cpp
index 327d75f..cf9b829 100644
--- a/tests/SparseMatrixTest.cpp
+++ b/tests/SparseMatrixTest.cpp
@@ -56,8 +56,8 @@ template <typename T, int n, int m> bool computeTest(const Eigen::Matrix<T, n, m
     constexpr double tolerance = 1e-4;
     bool outcome = matrix.isApprox(newMatrix, tolerance);
 
-    csc_spfree(osqpSparseMatrix);
-    csc_spfree(otherOsqpSparseMatrix);
+    OsqpEigen::spfree(osqpSparseMatrix);
+    OsqpEigen::spfree(otherOsqpSparseMatrix);
 
     return outcome;
 }