Squashed 'third_party/osqp/' content from commit 33454b3e23

Change-Id: I056df0582ca06664e86554c341a94c47ab932001
git-subtree-dir: third_party/osqp
git-subtree-split: 33454b3e236f1f44193bfbbb6b8c8e71f8f04e9a
Signed-off-by: Austin Schuh <austin.linux@gmail.com>
diff --git a/src/lin_sys.c b/src/lin_sys.c
new file mode 100644
index 0000000..fe617d3
--- /dev/null
+++ b/src/lin_sys.c
@@ -0,0 +1,75 @@
+#include "lin_sys.h"
+
+#include "qdldl_interface.h" // Include only this solver in the same directory
+
+const char *LINSYS_SOLVER_NAME[] = {
+  "qdldl", "mkl pardiso"
+};
+
+#ifdef ENABLE_MKL_PARDISO
+# include "pardiso_interface.h"
+# include "pardiso_loader.h"
+#endif /* ifdef ENABLE_MKL_PARDISO */
+
+// Load linear system solver shared library
+c_int load_linsys_solver(enum linsys_solver_type linsys_solver) {
+  switch (linsys_solver) {
+  case QDLDL_SOLVER:
+
+    // We do not load  QDLDL solver. We have the source.
+    return 0;
+
+# ifdef ENABLE_MKL_PARDISO
+  case MKL_PARDISO_SOLVER:
+
+    // Load Pardiso library
+    return lh_load_pardiso(OSQP_NULL);
+
+# endif /* ifdef ENABLE_MKL_PARDISO */
+  default: // QDLDL
+    return 0;
+  }
+}
+
+// Unload linear system solver shared library
+c_int unload_linsys_solver(enum linsys_solver_type linsys_solver) {
+  switch (linsys_solver) {
+  case QDLDL_SOLVER:
+
+    // We do not load QDLDL solver. We have the source.
+    return 0;
+
+# ifdef ENABLE_MKL_PARDISO
+  case MKL_PARDISO_SOLVER:
+
+    // Unload Pardiso library
+    return lh_unload_pardiso();
+
+# endif /* ifdef ENABLE_MKL_PARDISO */
+  default: //  QDLDL
+    return 0;
+  }
+}
+
+// Initialize linear system solver structure
+// NB: Only the upper triangular part of P is stuffed!
+c_int init_linsys_solver(LinSysSolver          **s,
+                         const csc              *P,
+                         const csc              *A,
+                         c_float                 sigma,
+                         const c_float          *rho_vec,
+                         enum linsys_solver_type linsys_solver,
+                         c_int                   polish) {
+  switch (linsys_solver) {
+  case QDLDL_SOLVER:
+    return init_linsys_solver_qdldl((qdldl_solver **)s, P, A, sigma, rho_vec, polish);
+
+# ifdef ENABLE_MKL_PARDISO
+  case MKL_PARDISO_SOLVER:
+    return init_linsys_solver_pardiso((pardiso_solver **)s, P, A, sigma, rho_vec, polish);
+
+# endif /* ifdef ENABLE_MKL_PARDISO */
+  default: // QDLDL
+    return init_linsys_solver_qdldl((qdldl_solver **)s, P, A, sigma, rho_vec, polish);
+  }
+}