lpsolver 0.1.0 → 0.2.1

data/ext/lpsolver-highs/highs/pdlp/cupdlp/cupdlp_utils.c

@@ -0,0 +1,1850 @@
+//
+// Created by chuwen on 23-11-26.
+//
+
+#include "pdlp/cupdlp/cupdlp_utils.h"
+
+#include <limits.h>
+#include <stdio.h>
+
+#include <time.h>
+
+#include "pdlp/cupdlp/cupdlp_cs.h"
+#include "pdlp/cupdlp/cupdlp_linalg.h"
+#include "pdlp/cupdlp/glbopts.h"
+
+#ifndef CUPDLP_CPU
+
+#include "cuda/cupdlp_cudalinalg.cuh"
+
+#endif
+
+void dense_clear(CUPDLPdense *dense) {
+  if (dense) {
+    if (dense->data) {
+      cupdlp_free(dense->data);
+    }
+    cupdlp_free(dense);
+  }
+}
+
+cupdlp_int csc_clear(CUPDLPcsc *csc) {
+  if (csc) {
+#ifndef CUPDLP_CPU
+    if (csc->cuda_csc != NULL) {
+      CHECK_CUSPARSE(cusparseDestroySpMat(csc->cuda_csc))
+    }
+#endif
+    if (csc->colMatBeg) {
+      CUPDLP_FREE_VEC(csc->colMatBeg);
+    }
+    if (csc->colMatIdx) {
+      CUPDLP_FREE_VEC(csc->colMatIdx);
+    }
+    if (csc->colMatElem) {
+      CUPDLP_FREE_VEC(csc->colMatElem);
+    }
+      cupdlp_free(csc);
+  }
+  return 0;
+}
+
+cupdlp_int csc_clear_host(CUPDLPcsc *csc) {
+  if (csc) {
+    if (csc->colMatBeg) {
+      cupdlp_free(csc->colMatBeg);
+    }
+    if (csc->colMatIdx) {
+      cupdlp_free(csc->colMatIdx);
+    }
+    if (csc->colMatElem) {
+      cupdlp_free(csc->colMatElem);
+    }
+    cupdlp_free(csc);
+  }
+  return 0;
+}
+
+cupdlp_int csr_clear(CUPDLPcsr *csr) {
+  if (csr) {
+#ifndef CUPDLP_CPU
+    if (csr->cuda_csr != NULL) {
+      CHECK_CUSPARSE(cusparseDestroySpMat(csr->cuda_csr))
+    }
+#endif
+    if (csr->rowMatBeg) {
+      CUPDLP_FREE_VEC(csr->rowMatBeg);
+    }
+    if (csr->rowMatIdx) {
+      CUPDLP_FREE_VEC(csr->rowMatIdx);
+    }
+    if (csr->rowMatElem) {
+      CUPDLP_FREE_VEC(csr->rowMatElem);
+    }
+    cupdlp_free(csr);
+  }
+  return 0;
+}
+
+void data_clear(CUPDLPdata *data) {
+  if (data) {
+    switch (data->matrix_format) {
+      case DENSE:
+        dense_clear(data->dense_matrix);
+        break;
+      case CSR:
+        csr_clear(data->csr_matrix);
+        break;
+      case CSC:
+        csc_clear(data->csc_matrix);
+        break;
+      case CSR_CSC:
+        csr_clear(data->csr_matrix);
+        csc_clear(data->csc_matrix);
+        break;
+    }
+    cupdlp_free(data);
+  }
+}
+
+void problem_clear(CUPDLPproblem *problem) {
+  if (problem) {
+    if (problem->data) {
+      data_clear(problem->data);
+    }
+    //        if (problem->colMatBeg) {
+    //            cupdlp_free(problem->colMatBeg);
+    //        }
+    //        if (problem->colMatIdx) {
+    //            cupdlp_free(problem->colMatIdx);
+    //        }
+    //        if (problem->colMatElem) {
+    //            cupdlp_free(problem->colMatElem);
+    //        }
+    //        if (problem->rowMatBeg) {
+    //            cupdlp_free(problem->rowMatBeg);
+    //        }
+    //        if (problem->rowMatIdx) {
+    //            cupdlp_free(problem->rowMatIdx);
+    //        }
+    //        if (problem->rowMatElem) {
+    //            cupdlp_free(problem->rowMatElem);
+    //        }
+    if (problem->lower) {
+      CUPDLP_FREE_VEC(problem->lower);
+    }
+    if (problem->upper) {
+      CUPDLP_FREE_VEC(problem->upper);
+    }
+    if (problem->cost) {
+      CUPDLP_FREE_VEC(problem->cost);
+    }
+    if (problem->rhs) {
+      CUPDLP_FREE_VEC(problem->rhs);
+    }
+    if (problem->hasLower) {
+      CUPDLP_FREE_VEC(problem->hasLower);
+    }
+    if (problem->hasUpper) {
+      CUPDLP_FREE_VEC(problem->hasUpper);
+    }
+    cupdlp_free(problem);
+  }
+}
+
+void settings_clear(CUPDLPsettings *settings) {
+  if (settings) {
+    cupdlp_free(settings);
+  }
+}
+
+cupdlp_int vec_clear(CUPDLPvec *vec) {
+  if (vec) {
+    if (vec->data) {
+      CUPDLP_FREE_VEC(vec->data);
+    }
+#ifndef CUPDLP_CPU
+    CHECK_CUSPARSE(cusparseDestroyDnVec(vec->cuda_vec))
+#endif
+    cupdlp_free(vec);
+  }
+
+  return 0;
+}
+
+void iterates_clear(CUPDLPiterates *iterates) {
+  if (iterates) {
+    if (iterates->x[0]) {
+      // CUPDLP_FREE_VEC(iterates->x[0]);
+      vec_clear(iterates->x[0]);
+    }
+    if (iterates->x[1]) {
+      // CUPDLP_FREE_VEC(iterates->x[1]);
+      vec_clear(iterates->x[1]);
+    }
+    if (iterates->y[0]) {
+      // CUPDLP_FREE_VEC(iterates->y[0]);
+      vec_clear(iterates->y[0]);
+    }
+    if (iterates->y[1]) {
+      // CUPDLP_FREE_VEC(iterates->y[1]);
+      vec_clear(iterates->y[1]);
+    }
+    if (iterates->xSum) {
+      CUPDLP_FREE_VEC(iterates->xSum);
+    }
+    if (iterates->ySum) {
+      CUPDLP_FREE_VEC(iterates->ySum);
+    }
+    if (iterates->xAverage) {
+      // CUPDLP_FREE_VEC(iterates->xAverage);
+      vec_clear(iterates->xAverage);
+    }
+    if (iterates->yAverage) {
+      // CUPDLP_FREE_VEC(iterates->yAverage);
+      vec_clear(iterates->yAverage);
+    }
+    if (iterates->xLastRestart) {
+      CUPDLP_FREE_VEC(iterates->xLastRestart);
+    }
+    if (iterates->yLastRestart) {
+      CUPDLP_FREE_VEC(iterates->yLastRestart);
+    }
+    if (iterates->ax[0]) {
+      // CUPDLP_FREE_VEC(iterates->ax[0]);
+      vec_clear(iterates->ax[0]);
+    }
+    if (iterates->ax[1]) {
+      // CUPDLP_FREE_VEC(iterates->ax[1]);
+      vec_clear(iterates->ax[1]);
+    }
+    if (iterates->axAverage) {
+      // CUPDLP_FREE_VEC(iterates->axAverage);
+      vec_clear(iterates->axAverage);
+    }
+    if (iterates->aty[0]) {
+      // CUPDLP_FREE_VEC(iterates->aty[0]);
+      vec_clear(iterates->aty[0]);
+    }
+    if (iterates->aty[1]) {
+      // CUPDLP_FREE_VEC(iterates->aty[1]);
+      vec_clear(iterates->aty[1]);
+    }
+    if (iterates->atyAverage) {
+      // CUPDLP_FREE_VEC(iterates->atyAverage);
+      vec_clear(iterates->atyAverage);
+    }
+    cupdlp_free(iterates);
+  }
+}
+
+void resobj_clear(CUPDLPresobj *resobj) {
+  if (resobj) {
+    if (resobj->primalResidual) {
+      CUPDLP_FREE_VEC(resobj->primalResidual);
+    }
+    if (resobj->dualResidual) {
+      CUPDLP_FREE_VEC(resobj->dualResidual);
+    }
+    if (resobj->primalResidualAverage) {
+      CUPDLP_FREE_VEC(resobj->primalResidualAverage);
+    }
+    if (resobj->dualResidualAverage) {
+      CUPDLP_FREE_VEC(resobj->dualResidualAverage);
+    }
+    if (resobj->dSlackPos) {
+      CUPDLP_FREE_VEC(resobj->dSlackPos);
+    }
+    if (resobj->dSlackNeg) {
+      CUPDLP_FREE_VEC(resobj->dSlackNeg);
+    }
+    if (resobj->dSlackPosAverage) {
+      CUPDLP_FREE_VEC(resobj->dSlackPosAverage);
+    }
+    if (resobj->dSlackNegAverage) {
+      CUPDLP_FREE_VEC(resobj->dSlackNegAverage);
+    }
+    if (resobj->dLowerFiltered) {
+      CUPDLP_FREE_VEC(resobj->dLowerFiltered);
+    }
+    if (resobj->dUpperFiltered) {
+      CUPDLP_FREE_VEC(resobj->dUpperFiltered);
+    }
+    if (resobj->primalInfeasRay) {
+      CUPDLP_FREE_VEC(resobj->primalInfeasRay);
+    }
+    if (resobj->primalInfeasConstr) {
+      CUPDLP_FREE_VEC(resobj->primalInfeasConstr);
+    }
+    if (resobj->primalInfeasBound) {
+      CUPDLP_FREE_VEC(resobj->primalInfeasBound);
+    }
+    if (resobj->dualInfeasRay) {
+      CUPDLP_FREE_VEC(resobj->dualInfeasRay);
+    }
+    if (resobj->dualInfeasLbRay) {
+      CUPDLP_FREE_VEC(resobj->dualInfeasLbRay);
+    }
+    if (resobj->dualInfeasUbRay) {
+      CUPDLP_FREE_VEC(resobj->dualInfeasUbRay);
+    }
+    if (resobj->dualInfeasConstr) {
+      CUPDLP_FREE_VEC(resobj->dualInfeasConstr);
+    }
+    // if (resobj->dualInfeasBound) {
+    //   CUPDLP_FREE_VEC(resobj->dualInfeasBound);
+    // }
+    cupdlp_free(resobj);
+  }
+}
+
+void stepsize_clear(CUPDLPstepsize *stepsize) {
+  if (stepsize) {
+    cupdlp_free(stepsize);
+  }
+}
+
+void timers_clear(int log_level, CUPDLPtimers *timers) {
+#ifndef CUPDLP_CPU
+if (log_level > 1)
+  cupdlp_printf("%20s %e\n\n", "Free Device memory", timers->FreeDeviceMemTime);
+#endif
+
+
+  if (timers) {
+    cupdlp_free(timers);
+  }
+}
+
+void scaling_clear(CUPDLPscaling *scaling) {
+  if (scaling) {
+    if (scaling->colScale) {
+      cupdlp_free(scaling->colScale);
+    }
+    if (scaling->rowScale) {
+      cupdlp_free(scaling->rowScale);
+    }
+    cupdlp_free(scaling);
+  }
+}
+
+cupdlp_int PDHG_Clear(CUPDLPwork *w) {
+  CUPDLPproblem *problem = w->problem;
+  CUPDLPsettings *settings = w->settings;
+  CUPDLPiterates *iterates = w->iterates;
+  CUPDLPresobj *resobj = w->resobj;
+  CUPDLPstepsize *stepsize = w->stepsize;
+  CUPDLPtimers *timers = w->timers;
+  CUPDLPscaling *scaling = w->scaling;
+
+
+  cupdlp_float begin = getTimeStamp();
+#ifndef CUPDLP_CPU
+
+  // CUDAmv *MV = w->MV;
+  // if (MV)
+  // {
+  //     cupdlp_float begin = getTimeStamp();
+  //     cuda_free_mv(MV);
+  //     timers->FreeDeviceMemTime += getTimeStamp() - begin;
+  // }
+  CHECK_CUBLAS(cublasDestroy(w->cublashandle))
+  CHECK_CUSPARSE(cusparseDestroy(w->cusparsehandle))
+  CHECK_CUDA(cudaFree(w->dBuffer_csc_ATy))
+  CHECK_CUDA(cudaFree(w->dBuffer_csr_Ax))
+  if (w->buffer2) CUPDLP_FREE_VEC(w->buffer2);
+  if (w->buffer3) CUPDLP_FREE_VEC(w->buffer3);
+#endif
+  if (w->colScale) CUPDLP_FREE_VEC(w->colScale);
+  if (w->rowScale) CUPDLP_FREE_VEC(w->rowScale);
+
+  if (w->buffer) {
+    // CUPDLP_FREE_VEC(w->buffer);
+    vec_clear(w->buffer);
+  }
+
+  if (w->buffer2 != NULL) {
+    // CUPDLP_FREE_VEC(w->buffer);
+    free(w->buffer2);
+  }
+
+  if (w->buffer3) {
+    // CUPDLP_FREE_VEC(w->buffer);
+    free(w->buffer3);
+  }
+
+  if (problem) {
+    // problem_clear(problem);
+    problem = cupdlp_NULL;
+  }
+
+  if (iterates) {
+    iterates_clear(iterates);
+  }
+
+  if (resobj) {
+    resobj_clear(resobj);
+  }
+
+#ifndef CUPDLP_CPU
+  timers->FreeDeviceMemTime += getTimeStamp() - begin;
+#endif
+
+  // Call timers_clear, before clearing settings
+  if (timers) {
+    timers_clear(settings->nLogLevel, timers);
+  }
+  if (settings) {
+    settings_clear(settings);
+  }
+  if (stepsize) {
+    stepsize_clear(stepsize);
+  }
+  if (scaling) {
+    // scaling_clear(scaling);
+    // if (scaling->colScale) {
+    //    cupdlp_free(scaling->colScale);
+    // }
+    // if (scaling->rowScale) {
+    //    cupdlp_free(scaling->rowScale);
+    // }
+    // cupdlp_free(scaling);
+    scaling = cupdlp_NULL;
+  }
+  cupdlp_free(w);
+
+  return 0;
+}
+
+void PDHG_PrintPDHGParam(CUPDLPwork *w) {
+  if (w->settings->nLogLevel < 2) return;
+  CUPDLPsettings *settings = w->settings;
+  CUPDLPstepsize *stepsize = w->stepsize;
+  CUPDLPresobj *resobj = w->resobj;
+  CUPDLPiterates *iterates = w->iterates;
+  CUPDLPscaling *scaling = w->scaling;
+  CUPDLPtimers *timers = w->timers;
+
+  cupdlp_printf("\n");
+
+  cupdlp_printf("\n");
+  cupdlp_printf("--------------------------------------------------\n");
+  cupdlp_printf("CUPDHG Parameters:\n");
+  cupdlp_printf("--------------------------------------------------\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    nIterLim:          %d\n", settings->nIterLim);
+  cupdlp_printf("    dTimeLim (sec):    %.2f\n", settings->dTimeLim);
+  cupdlp_printf("    ifScaling:         %d\n", settings->ifScaling);
+  // cupdlp_printf("    iScalingMethod:    %d\n", settings->iScalingMethod);)
+  cupdlp_printf("    ifRuizScaling:     %d\n", scaling->ifRuizScaling);
+  cupdlp_printf("    ifL2Scaling:       %d\n", scaling->ifL2Scaling);
+  cupdlp_printf("    ifPcScaling:       %d\n", scaling->ifPcScaling);
+  cupdlp_printf("    eLineSearchMethod: %d\n", stepsize->eLineSearchMethod);
+  // cupdlp_printf("    dScalingLimit:     %.4e\n", settings->dScalingLimit);
+  cupdlp_printf("    dPrimalTol:        %.4e\n", settings->dPrimalTol);
+  cupdlp_printf("    dDualTol:          %.4e\n", settings->dDualTol);
+  cupdlp_printf("    dGapTol:           %.4e\n", settings->dGapTol);
+  cupdlp_printf("    dFeasTol:          %.4e\n", resobj->dFeasTol);
+  cupdlp_printf("    eRestartMethod:    %d\n", settings->eRestartMethod);
+  cupdlp_printf("    nLogLevel:    %d\n", settings->nLogLevel);
+  cupdlp_printf("    nLogInterval:    %d\n", settings->nLogInterval);
+  cupdlp_printf("\n");
+  cupdlp_printf("--------------------------------------------------\n");
+  cupdlp_printf("\n");
+}
+
+void PDHG_PrintHugeCUPDHG(void) {
+  cupdlp_printf("\n");
+  cupdlp_printf("  ____ _   _ ____  ____  _     ____\n");
+  cupdlp_printf(" / ___| | | |  _ \\|  _ \\| |   |  _ \\\n");
+  cupdlp_printf("| |   | | | | |_) | | | | |   | |_) |\n");
+  cupdlp_printf("| |___| |_| |  __/| |_| | |___|  __/\n");
+  cupdlp_printf(" \\____|\\___/|_|   |____/|_____|_|\n");
+  cupdlp_printf("\n");
+}
+
+void PDHG_PrintUserParamHelper(void) {
+  PDHG_PrintHugeCUPDHG();
+
+  cupdlp_printf("CUPDHG User Parameters:\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -h: print this helper\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -nIterLim:  maximum iteration number\n");
+  cupdlp_printf("                type:    int\n");
+  cupdlp_printf("                default: INT_MAX\n");
+  cupdlp_printf("                range:   >= 0\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -ifScaling: whether to use scaling\n");
+  cupdlp_printf("                type:    bool\n");
+  cupdlp_printf("                default: true\n");
+  cupdlp_printf("                range:   true or false\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -eLineSearchMethod: which line search method to use\n");
+  cupdlp_printf(
+      "                        0-Fixed, 1-Malitsky (not support), "
+      "2-Adaptive\n");
+  cupdlp_printf("                type:    int\n");
+  cupdlp_printf("                default: 2\n");
+  cupdlp_printf("                range:   0 to 2\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -dPrimalTol: primal tolerance\n");
+  cupdlp_printf("                type:    double\n");
+  cupdlp_printf("                default: 1e-4\n");
+  cupdlp_printf("                range:   >= 0\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -dDualTol: dual tolerance\n");
+  cupdlp_printf("                type:    double\n");
+  cupdlp_printf("                default: 1e-4\n");
+  cupdlp_printf("                range:   >= 0\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -dGapTol: gap tolerance\n");
+  cupdlp_printf("                type:    double\n");
+  cupdlp_printf("                default: 1e-4\n");
+  cupdlp_printf("                range:   >= 0\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -dFeasTol: feasibility tolerance\n");
+  cupdlp_printf("                type:    double\n");
+  cupdlp_printf("                default: 1e-8\n");
+  cupdlp_printf("                range:   >= 0\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -dTimeLim: time limit (in seconds)\n");
+  cupdlp_printf("                type:    double\n");
+  cupdlp_printf("                default: 3600\n");
+  cupdlp_printf("                range:   >= 0\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -eRestartMethod: which restart method to use\n");
+  cupdlp_printf("                     0-None, 1-KKTversion\n");
+  cupdlp_printf("                type:    int\n");
+  cupdlp_printf("                default: 1\n");
+  cupdlp_printf("                range:   0 to 1\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -ifRuizScaling: whether to use Ruiz scaling\n");
+  cupdlp_printf("                type:    bool\n");
+  cupdlp_printf("                default: true\n");
+  cupdlp_printf("                range:   true or false\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -ifL2Scaling: whether to use L2 scaling\n");
+  cupdlp_printf("                type:    bool\n");
+  cupdlp_printf("                default: false\n");
+  cupdlp_printf("                range:   true or false\n");
+  cupdlp_printf("\n");
+
+  cupdlp_printf("    -ifPcScaling: whether to use Pock-Chambolle scaling\n");
+  cupdlp_printf("                type:    bool\n");
+  cupdlp_printf("                default: true\n");
+  cupdlp_printf("                range:   true or false\n");
+  cupdlp_printf("\n");
+
+  // cupdlp_printf(
+  //     "    -ifPre: whether to use HiGHS presolver (and thus postsolver)\n");
+  // cupdlp_printf("                type:    bool\n");
+  // cupdlp_printf("                default: true\n");
+  // cupdlp_printf("                range:   true or false\n");
+  // cupdlp_printf("\n");
+}
+
+cupdlp_retcode getUserParam(int argc, char **argv,
+                            cupdlp_bool *ifChangeIntParam, cupdlp_int *intParam,
+                            cupdlp_bool *ifChangeFloatParam,
+                            cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  // set ifChangeIntParam and ifChangeFloatParam to false
+  for (cupdlp_int i = 0; i < N_INT_USER_PARAM; ++i) {
+    ifChangeIntParam[i] = false;
+  }
+
+  for (cupdlp_int i = 0; i < N_FLOAT_USER_PARAM; ++i) {
+    ifChangeFloatParam[i] = false;
+  }
+
+  // parse command line arguments
+  for (cupdlp_int i = 0; i < argc - 1; ++i) {
+    if (strcmp(argv[i], "-h") == 0) {
+      PDHG_PrintUserParamHelper();
+
+      retcode = RETCODE_FAILED;
+      goto exit_cleanup;
+    }
+
+    if (strcmp(argv[i], "-nIterLim") == 0) {
+      ifChangeIntParam[N_ITER_LIM] = true;
+      intParam[N_ITER_LIM] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-ifScaling") == 0) {
+      ifChangeIntParam[IF_SCALING] = true;
+      intParam[IF_SCALING] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-iScalingMethod") == 0) {
+      ifChangeIntParam[I_SCALING_METHOD] = true;
+      intParam[I_SCALING_METHOD] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-eLineSearchMethod") == 0) {
+      ifChangeIntParam[E_LINE_SEARCH_METHOD] = true;
+      intParam[E_LINE_SEARCH_METHOD] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-dScalingLimit") == 0) {
+      ifChangeFloatParam[D_SCALING_LIMIT] = true;
+      floatParam[D_SCALING_LIMIT] = atof(argv[i + 1]);
+    } else if (strcmp(argv[i], "-dPrimalTol") == 0) {
+      ifChangeFloatParam[D_PRIMAL_TOL] = true;
+      floatParam[D_PRIMAL_TOL] = atof(argv[i + 1]);
+    } else if (strcmp(argv[i], "-dDualTol") == 0) {
+      ifChangeFloatParam[D_DUAL_TOL] = true;
+      floatParam[D_DUAL_TOL] = atof(argv[i + 1]);
+    } else if (strcmp(argv[i], "-dGapTol") == 0) {
+      ifChangeFloatParam[D_GAP_TOL] = true;
+      floatParam[D_GAP_TOL] = atof(argv[i + 1]);
+    } else if (strcmp(argv[i], "-dFeasTol") == 0) {
+      ifChangeFloatParam[D_FEAS_TOL] = true;
+      floatParam[D_FEAS_TOL] = atof(argv[i + 1]);
+    } else if (strcmp(argv[i], "-dTimeLim") == 0) {
+      ifChangeFloatParam[D_TIME_LIM] = true;
+      floatParam[D_TIME_LIM] = atof(argv[i + 1]);
+    } else if (strcmp(argv[i], "-eRestartMethod") == 0) {
+      ifChangeIntParam[E_RESTART_METHOD] = true;
+      intParam[E_RESTART_METHOD] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-ifRuizScaling") == 0) {
+      ifChangeIntParam[IF_RUIZ_SCALING] = true;
+      intParam[IF_RUIZ_SCALING] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-ifL2Scaling") == 0) {
+      ifChangeIntParam[IF_L2_SCALING] = true;
+      intParam[IF_L2_SCALING] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-ifPcScaling") == 0) {
+      ifChangeIntParam[IF_PC_SCALING] = true;
+      intParam[IF_PC_SCALING] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-nLogLevel") == 0) {
+      ifChangeIntParam[N_LOG_LEVEL] = true;
+      intParam[N_LOG_LEVEL] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-nLogInt") == 0) {
+      ifChangeIntParam[N_LOG_INTERVAL] = true;
+      intParam[N_LOG_INTERVAL] = atoi(argv[i + 1]);
+    } else if (strcmp(argv[i], "-ifPre") == 0) {
+      ifChangeIntParam[IF_PRESOLVE] = true;
+      intParam[IF_PRESOLVE] = atoi(argv[i + 1]);
+    }
+  }
+
+  // if (argc>0) {
+  //   if (strcmp(argv[argc - 1], "-h") == 0) {
+  //     PDHG_PrintUserParamHelper();
+      
+  //     retcode = RETCODE_FAILED;
+  //     goto exit_cleanup;
+  //   }
+  // }
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode settings_SetUserParam(CUPDLPsettings *settings,
+                                     cupdlp_bool *ifChangeIntParam,
+                                     cupdlp_int *intParam,
+                                     cupdlp_bool *ifChangeFloatParam,
+                                     cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  if (ifChangeIntParam[N_ITER_LIM]) {
+    settings->nIterLim = intParam[N_ITER_LIM];
+  }
+
+  if (ifChangeIntParam[N_LOG_LEVEL]) {
+    settings->nLogLevel = intParam[N_LOG_LEVEL];
+  }
+
+  if (ifChangeIntParam[N_LOG_INTERVAL]) {
+    settings->nLogInterval = intParam[N_LOG_INTERVAL];
+  }
+
+  if (ifChangeIntParam[IF_SCALING]) {
+    settings->ifScaling = intParam[IF_SCALING];
+  }
+
+  if (ifChangeIntParam[I_SCALING_METHOD]) {
+    settings->iScalingMethod = intParam[I_SCALING_METHOD];
+  }
+
+  if (ifChangeFloatParam[D_SCALING_LIMIT]) {
+    settings->dScalingLimit = floatParam[D_SCALING_LIMIT];
+  }
+
+  if (ifChangeFloatParam[D_PRIMAL_TOL]) {
+    settings->dPrimalTol = floatParam[D_PRIMAL_TOL];
+  }
+
+  if (ifChangeFloatParam[D_DUAL_TOL]) {
+    settings->dDualTol = floatParam[D_DUAL_TOL];
+  }
+
+  if (ifChangeFloatParam[D_GAP_TOL]) {
+    settings->dGapTol = floatParam[D_GAP_TOL];
+  }
+
+  if (ifChangeFloatParam[D_TIME_LIM]) {
+    settings->dTimeLim = floatParam[D_TIME_LIM];
+  }
+
+  if (ifChangeIntParam[E_RESTART_METHOD]) {
+    settings->eRestartMethod = intParam[E_RESTART_METHOD];
+  }
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode resobj_SetUserParam(CUPDLPresobj *resobj,
+                                   cupdlp_bool *ifChangeIntParam,
+                                   cupdlp_int *intParam,
+                                   cupdlp_bool *ifChangeFloatParam,
+                                   cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  if (ifChangeFloatParam[D_FEAS_TOL]) {
+    resobj->dFeasTol = floatParam[D_FEAS_TOL];
+  }
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode iterates_SetUserParam(CUPDLPiterates *iterates,
+                                     cupdlp_bool *ifChangeIntParam,
+                                     cupdlp_int *intParam,
+                                     cupdlp_bool *ifChangeFloatParam,
+                                     cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode stepsize_SetUserParam(CUPDLPstepsize *stepsize,
+                                     cupdlp_bool *ifChangeIntParam,
+                                     cupdlp_int *intParam,
+                                     cupdlp_bool *ifChangeFloatParam,
+                                     cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  if (ifChangeIntParam[E_LINE_SEARCH_METHOD]) {
+    stepsize->eLineSearchMethod = intParam[E_LINE_SEARCH_METHOD];
+  }
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode scaling_SetUserParam(CUPDLPscaling *scaling,
+                                    cupdlp_bool *ifChangeIntParam,
+                                    cupdlp_int *intParam,
+                                    cupdlp_bool *ifChangeFloatParam,
+                                    cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  if (ifChangeIntParam[IF_RUIZ_SCALING]) {
+    scaling->ifRuizScaling = intParam[IF_RUIZ_SCALING];
+  }
+
+  if (ifChangeIntParam[IF_L2_SCALING]) {
+    scaling->ifL2Scaling = intParam[IF_L2_SCALING];
+  }
+
+  if (ifChangeIntParam[IF_PC_SCALING]) {
+    scaling->ifPcScaling = intParam[IF_PC_SCALING];
+  }
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode timers_SetUserParam(CUPDLPtimers *timers,
+                                   cupdlp_bool *ifChangeIntParam,
+                                   cupdlp_int *intParam,
+                                   cupdlp_bool *ifChangeFloatParam,
+                                   cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode PDHG_SetUserParam(CUPDLPwork *w, cupdlp_bool *ifChangeIntParam,
+                                 cupdlp_int *intParam,
+                                 cupdlp_bool *ifChangeFloatParam,
+                                 cupdlp_float *floatParam) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  CUPDLPsettings *settings = w->settings;
+  CUPDLPstepsize *stepsize = w->stepsize;
+  CUPDLPresobj *resobj = w->resobj;
+  CUPDLPiterates *iterates = w->iterates;
+  CUPDLPscaling *scaling = w->scaling;
+  CUPDLPtimers *timers = w->timers;
+
+  CUPDLP_CALL(settings_SetUserParam(settings, ifChangeIntParam, intParam,
+                                    ifChangeFloatParam, floatParam));
+  CUPDLP_CALL(stepsize_SetUserParam(stepsize, ifChangeIntParam, intParam,
+                                    ifChangeFloatParam, floatParam));
+  CUPDLP_CALL(resobj_SetUserParam(resobj, ifChangeIntParam, intParam,
+                                  ifChangeFloatParam, floatParam));
+  CUPDLP_CALL(iterates_SetUserParam(iterates, ifChangeIntParam, intParam,
+                                    ifChangeFloatParam, floatParam));
+  CUPDLP_CALL(scaling_SetUserParam(scaling, ifChangeIntParam, intParam,
+                                   ifChangeFloatParam, floatParam));
+  CUPDLP_CALL(timers_SetUserParam(timers, ifChangeIntParam, intParam,
+                                  ifChangeFloatParam, floatParam));
+
+  PDHG_PrintPDHGParam(w);
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode settings_Alloc(CUPDLPsettings *settings) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  // settings->nIterLim = INFINITY;
+  settings->nIterLim = INT_MAX;  // INFINITY cause bug on MacOS
+  settings->nLogLevel = 2; // Ensures that, by default, cuPDLP-C printing is unchanged
+  settings->nLogInterval = 100;
+  // settings->dTimeLim = INFINITY;
+  settings->dTimeLim = 3600;
+  settings->ifScaling = true;
+  settings->iScalingMethod = 3;  // no use
+  settings->dScalingLimit = 5;   // no use
+  settings->eRestartMethod = PDHG_GPU_RESTART;
+
+  // termination criteria
+  settings->dPrimalTol = 1e-4;
+  settings->dDualTol = 1e-4;
+  settings->dGapTol = 1e-4;
+
+  return retcode;
+}
+
+cupdlp_retcode resobj_Alloc(CUPDLPresobj *resobj, CUPDLPproblem *problem,
+                            cupdlp_int ncols, cupdlp_int nrows) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+#if !defined(CUPDLP_CPU) && USE_KERNELS
+  resobj->primalResidual = NULL;
+  resobj->dualResidual = NULL;
+  resobj->primalResidualAverage = NULL;
+  resobj->dualResidualAverage = NULL;
+#else
+
+  cupdlp_init_zero_vec_double(resobj->primalResidual, nrows);
+  cupdlp_init_zero_vec_double(resobj->dualResidual, ncols);
+  cupdlp_init_zero_vec_double(resobj->primalResidualAverage, nrows);
+  cupdlp_init_zero_vec_double(resobj->dualResidualAverage, ncols);
+
+#endif
+
+  cupdlp_init_zero_vec_double(resobj->dSlackPos, ncols);
+  cupdlp_init_zero_vec_double(resobj->dSlackNeg, ncols);
+  cupdlp_init_zero_vec_double(resobj->dSlackPosAverage, ncols);
+  cupdlp_init_zero_vec_double(resobj->dSlackNegAverage, ncols);
+  cupdlp_init_zero_vec_double(resobj->dLowerFiltered, ncols);
+  cupdlp_init_zero_vec_double(resobj->dUpperFiltered, ncols);
+
+#if !defined(CUPDLP_CPU) && USE_KERNELS
+  resobj->primalInfeasRay = NULL;
+  resobj->primalInfeasConstr = NULL;
+  resobj->primalInfeasBound = NULL;
+  resobj->dualInfeasRay = NULL;
+  resobj->dualInfeasLbRay = NULL;
+  resobj->dualInfeasUbRay = NULL;
+#else
+
+  cupdlp_init_zero_vec_double(resobj->primalInfeasRay, ncols);
+  cupdlp_init_zero_vec_double(resobj->primalInfeasConstr, nrows);
+  cupdlp_init_zero_vec_double(resobj->primalInfeasBound, ncols);
+  cupdlp_init_zero_vec_double(resobj->dualInfeasRay, nrows);
+  cupdlp_init_zero_vec_double(resobj->dualInfeasLbRay, ncols);
+  cupdlp_init_zero_vec_double(resobj->dualInfeasUbRay, ncols);
+#endif
+
+
+#if !defined(CUPDLP_CPU) && USE_KERNELS
+  resobj->dualInfeasConstr = NULL;
+#else
+  cupdlp_init_zero_vec_double(resobj->dualInfeasConstr, ncols);
+#endif
+
+  // CUPDLP_INIT_DOUBLE_ZERO_VEC(resobj->dualInfeasBound, nrows);
+
+  cupdlp_filterlb(resobj->dLowerFiltered, problem->lower, -INFINITY, ncols);
+  cupdlp_filterub(resobj->dUpperFiltered, problem->upper, +INFINITY, ncols);
+
+  // initialization
+  resobj->dFeasTol = 1e-8;
+  resobj->dPrimalObj = 0.0;
+  resobj->dDualObj = 0.0;
+  resobj->dDualityGap = 0.0;
+  resobj->dComplementarity = 0.0;
+  resobj->dPrimalFeas = 0.0;
+  resobj->dDualFeas = 0.0;
+  resobj->dRelObjGap = 0.0;
+  resobj->dPrimalObjAverage = 0.0;
+  resobj->dDualObjAverage = 0.0;
+  resobj->dDualityGapAverage = 0.0;
+  resobj->dComplementarityAverage = 0.0;
+  resobj->dPrimalFeasAverage = 0.0;
+  resobj->dDualFeasAverage = 0.0;
+  resobj->dRelObjGapAverage = 0.0;
+  resobj->dPrimalFeasLastRestart = 0.0;
+  resobj->dDualFeasLastRestart = 0.0;
+  resobj->dDualityGapLastRestart = 0.0;
+  resobj->dPrimalFeasLastCandidate = 0.0;
+  resobj->dDualFeasLastCandidate = 0.0;
+  resobj->dDualityGapLastCandidate = 0.0;
+
+  resobj->primalCode = FEASIBLE;
+  resobj->dualCode = FEASIBLE;
+  resobj->termInfeasIterate = LAST_ITERATE;
+  resobj->dPrimalInfeasObj = 0.0;
+  resobj->dDualInfeasObj = 0.0;
+  resobj->dPrimalInfeasRes = 1.0;
+  resobj->dDualInfeasRes = 1.0;
+  resobj->dPrimalInfeasObjAverage = 0.0;
+  resobj->dDualInfeasObjAverage = 0.0;
+  resobj->dPrimalInfeasResAverage = 1.0;
+  resobj->dDualInfeasResAverage = 1.0;
+
+  resobj->termCode = TIMELIMIT_OR_ITERLIMIT;
+  resobj->termIterate = LAST_ITERATE;
+
+  // todo, pass work
+  //   cupdlp_twoNorm(problem->cost, ncols, &resobj->dNormCost);
+  //   twoNorm(problem->rhs, nrows);
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode iterates_Alloc(CUPDLPiterates *iterates, cupdlp_int ncols,
+                              cupdlp_int nrows) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  iterates->nCols = ncols;
+  iterates->nRows = nrows;
+
+  cupdlp_init_zero_vec_double(iterates->xSum, ncols);
+  cupdlp_init_zero_vec_double(iterates->ySum, nrows);
+  cupdlp_init_zero_vec_double(iterates->xLastRestart, ncols);
+  cupdlp_init_zero_vec_double(iterates->yLastRestart, nrows);
+
+  CUPDLP_INIT_CUPDLP_VEC(iterates->x[0], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->x[1], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->xAverage, 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->y[0], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->y[1], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->yAverage, 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->ax[0], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->ax[1], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->axAverage, 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->aty[0], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->aty[1], 1);
+  CUPDLP_INIT_CUPDLP_VEC(iterates->atyAverage, 1);
+
+  CUPDLP_CALL(vec_Alloc(iterates->x[0], ncols));
+  CUPDLP_CALL(vec_Alloc(iterates->x[1], ncols));
+  CUPDLP_CALL(vec_Alloc(iterates->xAverage, ncols));
+  CUPDLP_CALL(vec_Alloc(iterates->y[0], nrows));
+  CUPDLP_CALL(vec_Alloc(iterates->y[1], nrows));
+  CUPDLP_CALL(vec_Alloc(iterates->yAverage, nrows));
+  CUPDLP_CALL(vec_Alloc(iterates->ax[0], nrows));
+  CUPDLP_CALL(vec_Alloc(iterates->ax[1], nrows));
+  CUPDLP_CALL(vec_Alloc(iterates->axAverage, nrows));
+  CUPDLP_CALL(vec_Alloc(iterates->aty[0], ncols));
+  CUPDLP_CALL(vec_Alloc(iterates->aty[1], ncols));
+  CUPDLP_CALL(vec_Alloc(iterates->atyAverage, ncols));
+
+  // initialization
+  iterates->iLastRestartIter = 0;
+  iterates->dLastRestartDualityGap = 0.0;
+  iterates->dLastRestartBeta = 0.0;
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode stepsize_Alloc(CUPDLPstepsize *stepsize) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  stepsize->eLineSearchMethod = PDHG_ADAPTIVE_LINESEARCH;
+
+  // initialization
+  stepsize->nStepSizeIter = 0;
+  stepsize->dPrimalStep = 0.0;
+  stepsize->dDualStep = 0.0;
+  stepsize->dSumPrimalStep = 0.0;
+  stepsize->dSumDualStep = 0.0;
+  stepsize->dBeta = 0.0;
+  stepsize->dTheta = 0.0;
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode timers_Alloc(CUPDLPtimers *timers) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  timers->nIter = 0;
+  timers->dSolvingTime = 0.0;
+  timers->dSolvingBeg = 0.0;
+  timers->dScalingTime = 0.0;
+  timers->dPresolveTime = 0.0;
+
+#if PDHG_USE_TIMERS
+  timers->dAtyTime = 0.0;
+  timers->dAxTime = 0.0;
+  timers->dComputeResidualsTime = 0.0;
+  timers->dUpdateIterateTime = 0.0;
+  timers->nAtyCalls = 0;
+  timers->nAxCalls = 0;
+  timers->nComputeResidualsCalls = 0;
+  timers->nUpdateIterateCalls = 0;
+#endif
+#ifndef CUPDLP_CPU
+  // GPU timers
+  timers->AllocMem_CopyMatToDeviceTime = 0.0;
+  timers->CopyVecToDeviceTime = 0.0;
+  timers->DeviceMatVecProdTime = 0.0;
+  timers->CopyVecToHostTime = 0.0;
+  timers->FreeDeviceMemTime = 0.0;
+  timers->CudaPrepareTime = 0.0;
+#endif
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode vec_Alloc(CUPDLPvec *vec, cupdlp_int n) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  cupdlp_init_zero_vec_double(vec->data, n);
+  vec->len = n;
+#ifndef CUPDLP_CPU
+  CHECK_CUSPARSE(
+      cusparseCreateDnVec(&vec->cuda_vec, n, vec->data, CudaComputeType))
+#endif
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode PDHG_Alloc(CUPDLPwork *w) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  CUPDLP_INIT_SETTINGS(w->settings, 1);
+  CUPDLP_INIT_RESOBJ(w->resobj, 1);
+  CUPDLP_INIT_ITERATES(w->iterates, 1);
+  CUPDLP_INIT_STEPSIZE(w->stepsize, 1);
+
+  CUPDLP_INIT_TIMERS(w->timers, 1);
+  CUPDLP_CALL(timers_Alloc(w->timers));
+
+  cupdlp_float begin = getTimeStamp();
+  // buffer
+  CUPDLP_INIT_CUPDLP_VEC(w->buffer, 1);
+  CUPDLP_CALL(vec_Alloc(w->buffer, w->problem->data->nRows));
+
+
+  cupdlp_init_zero_vec_double(w->buffer2,
+                       MAX(2048, MAX(w->problem->data->nCols, w->problem->data->nRows)));
+#if defined(CUPDLP_CPU) || !(USE_KERNELS) || (CUPDLP_DUMP_LINESEARCH_STATS && CUPDLP_DEBUG)
+  cupdlp_init_zero_vec_double(w->buffer3,
+                       MAX(2048, MAX(w->problem->data->nCols, w->problem->data->nRows)));
+#else
+  w->buffer3 = NULL;
+#endif
+
+  // for scaling
+  cupdlp_init_zero_vec_double(w->colScale, w->problem->data->nCols);
+  cupdlp_init_zero_vec_double(w->rowScale, w->problem->data->nRows);
+
+  CUPDLP_CALL(settings_Alloc(w->settings));
+  CUPDLP_CALL(resobj_Alloc(w->resobj, w->problem, w->problem->data->nCols,
+                           w->problem->data->nRows));
+  CUPDLP_CALL(iterates_Alloc(w->iterates, w->problem->data->nCols,
+                             w->problem->data->nRows));
+  CUPDLP_CALL(stepsize_Alloc(w->stepsize));
+
+#ifndef CUPDLP_CPU
+  //   CHECK_CUSPARSE(cusparseCreate(&w->cusparsehandle));
+  //   CHECK_CUBLAS(cublasCreate(&w->cublashandle));
+  CUPDLP_CALL(cuda_alloc_MVbuffer(
+      //   w->problem->data->matrix_format,
+      w->cusparsehandle, w->problem->data->csc_matrix->cuda_csc,
+      w->iterates->x[0]->cuda_vec, w->iterates->ax[0]->cuda_vec,
+      w->problem->data->csr_matrix->cuda_csr, w->iterates->y[0]->cuda_vec,
+      w->iterates->aty[0]->cuda_vec, &w->dBuffer_csc_ATy, &w->dBuffer_csr_Ax))
+  w->timers->AllocMem_CopyMatToDeviceTime += getTimeStamp() - begin;
+#endif
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode PDHG_Create(CUPDLPwork **ww, CUPDLPproblem *lp,
+                           CUPDLPscaling *scaling) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  CUPDLP_INIT_ZERO_CUPDLP_WORK(*ww, 1);
+
+  CUPDLPwork *w = *ww;
+  w->problem = lp;
+  w->scaling = scaling;
+
+exit_cleanup:
+  return retcode;
+}
+
+void PDHG_Destroy(CUPDLPwork **w) {
+  if (w && *w) {
+    PDHG_Clear(*w);
+  }
+}
+
+void PDHG_Init_Data(CUPDLPwork *work) {}
+
+// double my_clock(void) {
+
+// #ifdef CUPDLP_TIMER
+
+// #if defined(_WIN32) || defined(_WIN64)
+//   return (double)clock() / CLOCKS_PER_SEC;
+// #else
+//   struct timeval t;
+//   gettimeofday(&t, NULL);
+//   return (1e-06 * t.tv_usec + t.tv_sec);
+// #endif
+
+// #else
+//   return 0;
+// #endif
+
+// }
+
+
+double my_clock(void) {
+#ifdef CUPDLP_TIMER
+  // struct timeval t;
+  // clock_gettime(&t, NULL);
+  // gettimeofday(&t, NULL);
+  double timeee = 0;
+
+#ifndef WIN32
+  timeee = time(NULL);
+#else
+  timeee = clock();
+#endif
+
+  return timeee;
+  // return (1e-06 * t.tv_usec + t.tv_sec);
+#else
+  return 0;
+#endif
+}
+
+double getTimeStamp(void) { return my_clock(); }
+
+void dense_copy(CUPDLPdense *dst, CUPDLPdense *src) {
+  dst->nRows = src->nRows;
+  dst->nCols = src->nCols;
+  cupdlp_copy(dst->data, src->data, cupdlp_float, src->nRows * src->nCols);
+
+  return;
+}
+
+void csr_copy(CUPDLPcsr *dst, CUPDLPcsr *src) {
+  dst->nRows = src->nRows;
+  dst->nCols = src->nCols;
+  dst->nMatElem = src->nMatElem;
+  cupdlp_copy(dst->rowMatBeg, src->rowMatBeg, cupdlp_int, src->nRows + 1);
+  cupdlp_copy(dst->rowMatIdx, src->rowMatIdx, cupdlp_int, src->nMatElem);
+  cupdlp_copy(dst->rowMatElem, src->rowMatElem, cupdlp_float, src->nMatElem);
+
+  return;
+}
+
+cupdlp_int csc_copy(CUPDLPcsc *dst, CUPDLPcsc *src) {
+  dst->nRows = src->nRows;
+  dst->nCols = src->nCols;
+  dst->nMatElem = src->nMatElem;
+  CUPDLP_COPY_VEC(dst->colMatBeg, src->colMatBeg, cupdlp_int, src->nCols + 1);
+  CUPDLP_COPY_VEC(dst->colMatIdx, src->colMatIdx, cupdlp_int, src->nMatElem);
+  CUPDLP_COPY_VEC(dst->colMatElem, src->colMatElem, cupdlp_float,
+                  src->nMatElem);
+
+#ifndef CUPDLP_CPU
+  // Pointer to GPU csc matrix
+  CHECK_CUSPARSE(cusparseCreateCsc(
+      &dst->cuda_csc, src->nRows, src->nCols, src->nMatElem, dst->colMatBeg,
+      dst->colMatIdx, dst->colMatElem, CUSPARSE_INDEX_32I, CUSPARSE_INDEX_32I,
+      CUSPARSE_INDEX_BASE_ZERO, CudaComputeType));
+#endif
+
+  return 0;
+}
+
+void csr2csc(CUPDLPcsc *csc, CUPDLPcsr *csr) {
+  cupdlp_dcs *cs_csr =
+      cupdlp_dcs_spalloc(csr->nCols, csc->nRows, csc->nMatElem, 1, 0);
+  cupdlp_copy(cs_csr->p, csr->rowMatBeg, cupdlp_int, csr->nRows + 1);
+  cupdlp_copy(cs_csr->i, csr->rowMatIdx, cupdlp_int, csr->nMatElem);
+  cupdlp_copy(cs_csr->x, csr->rowMatElem, cupdlp_float, csr->nMatElem);
+
+  cupdlp_dcs *cs_csc = cupdlp_dcs_transpose(cs_csr, 1);
+  csc->nCols = cs_csc->m;
+  csc->nRows = cs_csc->n;
+  csc->nMatElem = cs_csc->nzmax;
+  cupdlp_copy(csc->colMatBeg, cs_csc->p, cupdlp_int, cs_csc->n + 1);
+  cupdlp_copy(csc->colMatIdx, cs_csc->i, cupdlp_int, cs_csc->nzmax);
+  cupdlp_copy(csc->colMatElem, cs_csc->x, cupdlp_float, cs_csc->nzmax);
+
+  // cupdlp_dcs_free(cs_csc);
+  // cupdlp_dcs_free(cs_csr);
+  cupdlp_dcs_spfree(cs_csc);
+  cupdlp_dcs_spfree(cs_csr);
+
+  return;
+}
+
+cupdlp_int csc2csr(CUPDLPcsr *csr, CUPDLPcsc *csc) {
+  // The transpose may need to be done on the GPU
+  // Currently, it is done on the CPU
+
+  cupdlp_dcs *cs_csc =
+      cupdlp_dcs_spalloc(csc->nRows, csc->nCols, csc->nMatElem, 1, 0);
+  cupdlp_copy(cs_csc->p, csc->colMatBeg, cupdlp_int, csc->nCols + 1);
+  cupdlp_copy(cs_csc->i, csc->colMatIdx, cupdlp_int, csc->nMatElem);
+  cupdlp_copy(cs_csc->x, csc->colMatElem, cupdlp_float, csc->nMatElem);
+
+  cupdlp_dcs *cs_csr = cupdlp_dcs_transpose(cs_csc, 1);
+  csr->nCols = cs_csr->m;
+  csr->nRows = cs_csr->n;
+  csr->nMatElem = cs_csr->nzmax;
+  CUPDLP_COPY_VEC(csr->rowMatBeg, cs_csr->p, cupdlp_int, cs_csr->n + 1);
+  CUPDLP_COPY_VEC(csr->rowMatIdx, cs_csr->i, cupdlp_int, cs_csr->nzmax);
+  CUPDLP_COPY_VEC(csr->rowMatElem, cs_csr->x, cupdlp_float, cs_csr->nzmax);
+
+  // cupdlp_dcs_free(cs_csc);
+  // cupdlp_dcs_free(cs_csr);
+  cupdlp_dcs_spfree(cs_csc);
+  cupdlp_dcs_spfree(cs_csr);
+
+#ifndef CUPDLP_CPU
+  // Pointer to GPU csc matrix
+  CHECK_CUSPARSE(cusparseCreateCsr(
+      &csr->cuda_csr, csr->nRows, csr->nCols, csr->nMatElem, csr->rowMatBeg,
+      csr->rowMatIdx, csr->rowMatElem, CUSPARSE_INDEX_32I, CUSPARSE_INDEX_32I,
+      CUSPARSE_INDEX_BASE_ZERO, CudaComputeType));
+#endif
+
+  return 0;
+}
+
+void dense2csr(CUPDLPcsr *csr, CUPDLPdense *dense) {
+  csr->nRows = dense->nRows;
+  csr->nCols = dense->nCols;
+
+  cupdlp_int nnz = 0;
+  cupdlp_int iCol = 0;
+  cupdlp_int iRow = 0;
+  csr->rowMatBeg[0] = 0;
+  for (iRow = 0; iRow < csr->nRows; ++iRow) {
+    for (iCol = 0; iCol < csr->nCols; ++iCol) {
+      if (dense->data[iCol * csr->nRows + iRow] != 0) {
+        csr->rowMatIdx[nnz] = iCol;
+        csr->rowMatElem[nnz] = dense->data[iCol * csr->nRows + iRow];
+        ++nnz;
+      }
+    }
+    csr->rowMatBeg[iRow + 1] = nnz;
+  }
+  csr->nMatElem = nnz;
+
+  return;
+}
+
+void dense2csc(CUPDLPcsc *csc, CUPDLPdense *dense) {
+  csc->nRows = dense->nRows;
+  csc->nCols = dense->nCols;
+
+  cupdlp_int nnz = 0;
+  cupdlp_int iCol = 0;
+  cupdlp_int iRow = 0;
+  csc->colMatBeg[0] = 0;
+  for (iCol = 0; iCol < csc->nCols; ++iCol) {
+    for (iRow = 0; iRow < csc->nRows; ++iRow) {
+      if (dense->data[iCol * csc->nRows + iRow] != 0) {
+        csc->colMatIdx[nnz] = iRow;
+        csc->colMatElem[nnz] = dense->data[iCol * csc->nRows + iRow];
+        ++nnz;
+      }
+    }
+    csc->colMatBeg[iCol + 1] = nnz;
+  }
+
+  csc->nMatElem = nnz;
+
+  return;
+}
+
+void csr2dense(CUPDLPdense *dense, CUPDLPcsr *csr) {
+  dense->nRows = csr->nRows;
+  dense->nCols = csr->nCols;
+
+  cupdlp_int iRow = 0;
+  cupdlp_int iCol = 0;
+  cupdlp_int iMatElem = 0;
+  for (iRow = 0; iRow < dense->nRows; ++iRow)
+    for (iCol = 0; iCol < dense->nCols; ++iCol) {
+      if (iCol == csr->rowMatIdx[iMatElem]) {
+        dense->data[iRow * dense->nCols + iCol] = csr->rowMatElem[iMatElem];
+        ++iMatElem;
+      } else {
+        dense->data[iRow * dense->nCols + iCol] = 0;
+      }
+    }
+
+  return;
+}
+
+void csc2dense(CUPDLPdense *dense, CUPDLPcsc *csc) {
+  dense->nRows = csc->nRows;
+  dense->nCols = csc->nCols;
+
+  cupdlp_int iRow = 0;
+  cupdlp_int iCol = 0;
+  cupdlp_int iMatElem = 0;
+  for (iCol = 0; iCol < dense->nCols; ++iCol)
+    for (iRow = 0; iRow < dense->nRows; ++iRow) {
+      if (iRow == csc->colMatIdx[iMatElem]) {
+        dense->data[iRow * dense->nCols + iCol] = csc->colMatElem[iMatElem];
+        ++iMatElem;
+      } else {
+        dense->data[iRow * dense->nCols + iCol] = 0;
+      }
+    }
+
+  return;
+}
+
+cupdlp_retcode dense_create(CUPDLPdense **dense) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  CUPDLP_INIT_DENSE_MATRIX(*dense, 1);
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode csr_create(CUPDLPcsr **csr) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  CUPDLP_INIT_CSR_MATRIX(*csr, 1);
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode csc_create(CUPDLPcsc **csc) {
+  cupdlp_retcode retcode = RETCODE_OK;
+
+  CUPDLP_INIT_CSC_MATRIX(*csc, 1);
+
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode dense_alloc_matrix(CUPDLPdense *dense, cupdlp_int nRows,
+                                  cupdlp_int nCols, void *src,
+                                  CUPDLP_MATRIX_FORMAT src_matrix_format) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  cupdlp_init_zero_vec_double(dense->data, nRows * nCols);
+
+  switch (src_matrix_format) {
+    case DENSE:
+      dense_copy(dense, (CUPDLPdense *)src);
+      break;
+    case CSR:
+      csr2dense(dense, (CUPDLPcsr *)src);
+      break;
+    case CSC:
+      csc2dense(dense, (CUPDLPcsc *)src);
+      break;
+    default:
+      break;
+  }
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode csr_alloc_matrix(CUPDLPcsr *csr, cupdlp_int nRows,
+                                cupdlp_int nCols, void *src,
+                                CUPDLP_MATRIX_FORMAT src_matrix_format) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  cupdlp_int nnz = 0;
+  switch (src_matrix_format) {
+    case DENSE:
+      nnz = nRows * nCols;
+      break;
+    case CSR:
+      nnz = ((CUPDLPcsr *)src)->nMatElem;
+      break;
+    case CSC:
+      nnz = ((CUPDLPcsc *)src)->nMatElem;
+      break;
+    default:
+      break;
+  }
+  // todo make sure this is right
+  cupdlp_init_zero_vec_int(csr->rowMatBeg, nRows + 1);
+  cupdlp_init_zero_vec_int(csr->rowMatIdx, nnz);
+  cupdlp_init_zero_vec_double(csr->rowMatElem, nnz);
+
+  switch (src_matrix_format) {
+    case DENSE:
+      dense2csr(csr, (CUPDLPdense *)src);
+      break;
+    case CSR:
+      csr_copy(csr, (CUPDLPcsr *)src);
+      break;
+    case CSC:
+      csc2csr(csr, (CUPDLPcsc *)src);
+      break;
+    default:
+      break;
+  }
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode csc_alloc_matrix(CUPDLPcsc *csc, cupdlp_int nRows,
+                                cupdlp_int nCols, void *src,
+                                CUPDLP_MATRIX_FORMAT src_matrix_format) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  cupdlp_int nnz = 0;
+  switch (src_matrix_format) {
+    case DENSE:
+      nnz = nRows * nCols;
+      break;
+    case CSR:
+      nnz = ((CUPDLPcsr *)src)->nMatElem;
+      break;
+    case CSC:
+      nnz = ((CUPDLPcsc *)src)->nMatElem;
+      break;
+    default:
+      break;
+  }
+
+  cupdlp_init_zero_vec_int(csc->colMatBeg, nCols + 1);
+  cupdlp_init_zero_vec_int(csc->colMatIdx, nnz);
+  cupdlp_init_zero_vec_double(csc->colMatElem, nnz);
+
+  switch (src_matrix_format) {
+    case DENSE:
+      dense2csc(csc, (CUPDLPdense *)src);
+      break;
+    case CSR:
+      csr2csc(csc, (CUPDLPcsr *)src);
+      break;
+    case CSC:
+      csc_copy(csc, (CUPDLPcsc *)src);
+      break;
+    default:
+      break;
+  }
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode dense_alloc(CUPDLPdense *dense, cupdlp_int nRows,
+                           cupdlp_int nCols, cupdlp_float *val) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  dense->nRows = nRows;
+  dense->nCols = nCols;
+  dense->data = cupdlp_NULL;
+  cupdlp_init_zero_vec_double(dense->data, nRows * nCols);
+
+  CUPDLP_COPY_VEC(dense->data, val, cupdlp_float, nRows * nCols);
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode csr_alloc(CUPDLPcsr *csr, cupdlp_int nRows, cupdlp_int nCols,
+                         cupdlp_int nnz, cupdlp_int *row_ptr,
+                         cupdlp_int *col_ind, cupdlp_float *val) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  csr->nRows = nRows;
+  csr->nCols = nCols;
+  csr->nMatElem = nnz;
+  csr->rowMatBeg = cupdlp_NULL;
+  csr->rowMatIdx = cupdlp_NULL;
+  csr->rowMatElem = cupdlp_NULL;
+
+  cupdlp_init_zero_vec_int(csr->rowMatBeg, nRows + 1);
+  cupdlp_init_zero_vec_int(csr->rowMatIdx, nnz);
+  cupdlp_init_zero_vec_double(csr->rowMatElem, nnz);
+
+  CUPDLP_COPY_VEC(csr->rowMatBeg, row_ptr, cupdlp_int, nRows + 1);
+  CUPDLP_COPY_VEC(csr->rowMatIdx, col_ind, cupdlp_int, nnz);
+  CUPDLP_COPY_VEC(csr->rowMatElem, val, cupdlp_float, nnz);
+exit_cleanup:
+  return retcode;
+}
+
+cupdlp_retcode csc_alloc(CUPDLPcsc *csc, cupdlp_int nRows, cupdlp_int nCols,
+                         cupdlp_int nnz, cupdlp_int *col_ptr,
+                         cupdlp_int *row_ind, cupdlp_float *val) {
+  cupdlp_retcode retcode = RETCODE_OK;
+  csc->nRows = nRows;
+  csc->nCols = nCols;
+  csc->nMatElem = nnz;
+  csc->colMatBeg = cupdlp_NULL;
+  csc->colMatIdx = cupdlp_NULL;
+  csc->colMatElem = cupdlp_NULL;
+  cupdlp_init_zero_vec_int(csc->colMatBeg, nCols + 1);
+  cupdlp_init_zero_vec_int(csc->colMatIdx, nnz);
+  cupdlp_init_zero_vec_double(csc->colMatElem, nnz);
+
+  CUPDLP_COPY_VEC(csc->colMatBeg, col_ptr, cupdlp_int, nCols + 1);
+  CUPDLP_COPY_VEC(csc->colMatIdx, row_ind, cupdlp_int, nnz);
+  CUPDLP_COPY_VEC(csc->colMatElem, val, cupdlp_float, nnz);
+exit_cleanup:
+  return retcode;
+}
+
+void vecPrint(const char *s, const cupdlp_float *a, cupdlp_int n) {
+  cupdlp_printf("%s: ", s);
+  for (cupdlp_int i = 0; i < n; ++i) {
+    cupdlp_printf("%.3f ", a[i]);
+  }
+  cupdlp_printf("\n");
+}
+
+void vecIntPrint(const char *s, const cupdlp_int *a, cupdlp_int n) {
+  cupdlp_printf("%s: ", s);
+  for (cupdlp_int i = 0; i < n; ++i) {
+    cupdlp_printf("%d ", a[i]);
+  }
+  cupdlp_printf("\n");
+}
+
+void PDHG_Dump_Stats(CUPDLPwork *w) {
+  cupdlp_int nCols = w->iterates->nCols;
+  cupdlp_int nRows = w->iterates->nRows;
+  CUPDLPiterates *iterates = w->iterates;
+  CUPDLPstepsize *stepsize = w->stepsize;
+
+  cupdlp_printf("------------------------------------------------\n");
+  cupdlp_printf("Iteration % 3d\n", w->timers->nIter);
+#if CUPDLP_DUMP_ITERATES
+  cupdlp_int iter = w->timers->nIter;
+  CUPDLPvec *x = iterates->x[iter % 2];
+  CUPDLPvec *y = iterates->y[iter % 2];
+  CUPDLPvec *aty = iterates->aty[iter % 2];
+
+  vecPrint("x", x->data, nCols);
+  vecPrint("y", y->data, nRows);
+  vecPrint("xSum", iterates->xSum, nCols);
+  vecPrint("ySum", iterates->ySum, nRows);
+  vecPrint("Ax ", ax->data, nRows);
+  vecPrint("A'y", aty->data, nCols);
+  vecPrint("xLastRestart", iterates->xLastRestart, nCols);
+  vecPrint("yLastRestart", iterates->yLastRestart, nRows);
+#endif
+  cupdlp_printf(
+      "PrimalStep: %e, SumPrimalStep: %e, DualStep: %e, SumDualStep: %e\n",
+      stepsize->dPrimalStep, stepsize->dSumPrimalStep, stepsize->dDualStep,
+      stepsize->dSumDualStep);
+  cupdlp_printf("Stepsize: %e, Primal weight: %e Ratio: %e\n",
+                sqrt(stepsize->dPrimalStep * stepsize->dDualStep),
+                sqrt(stepsize->dBeta), stepsize->dTheta);
+}
+
+void csrPrintDense(const char *s, CUPDLPcsr *csr) {
+  cupdlp_printf("------------------------------------------------\n");
+  cupdlp_printf("%s:\n", s);
+  cupdlp_int deltaCol = 0;
+  for (cupdlp_int iRow = 0; iRow < csr->nRows; ++iRow) {
+    for (cupdlp_int iElem = csr->rowMatBeg[iRow];
+         iElem < csr->rowMatBeg[iRow + 1]; ++iElem) {
+      if (iElem == csr->rowMatBeg[iRow])
+        deltaCol = csr->rowMatIdx[iElem];
+      else
+        deltaCol = csr->rowMatIdx[iElem] - csr->rowMatIdx[iElem - 1] - 1;
+      for (cupdlp_int i = 0; i < deltaCol; ++i) {
+        cupdlp_printf("       ");
+      }
+      cupdlp_printf("%6.3f ", csr->rowMatElem[iElem]);
+    }
+    cupdlp_printf("\n");
+  }
+  cupdlp_printf("------------------------------------------------\n");
+}
+
+void cscPrintDense(const char *s, CUPDLPcsc *csc) {
+  cupdlp_printf("------------------------------------------------\n");
+  cupdlp_printf("%s (Trans):\n", s);
+  cupdlp_int deltaRow = 0;
+  for (cupdlp_int iCol = 0; iCol < csc->nCols; ++iCol) {
+    for (cupdlp_int iElem = csc->colMatBeg[iCol];
+         iElem < csc->colMatBeg[iCol + 1]; ++iElem) {
+      if (iElem == csc->colMatBeg[iCol])
+        deltaRow = csc->colMatIdx[iElem];
+      else
+        deltaRow = csc->colMatIdx[iElem] - csc->colMatIdx[iElem - 1] - 1;
+      for (cupdlp_int i = 0; i < deltaRow; ++i) {
+        cupdlp_printf("       ");
+      }
+      cupdlp_printf("%6.3f ", csc->colMatElem[iElem]);
+    }
+    cupdlp_printf("\n");
+  }
+  cupdlp_printf("------------------------------------------------\n");
+}
+
+#ifndef CUPDLP_OUTPUT_NAMES
+const char *termCodeNames[] = {"OPTIMAL",
+                               "INFEASIBLE",
+                               "UNBOUNDED",
+                               "INFEASIBLE_OR_UNBOUNDED",
+                               "TIMELIMIT_OR_ITERLIMIT",
+                               "FEASIBLE"};
+const char *termIterateNames[] = {
+    "LAST_ITERATE",
+    "AVERAGE_ITERATE",
+};
+#endif
+
+void writeJson(const char *fout, CUPDLPwork *work) {
+  FILE *fptr;
+
+  cupdlp_printf("--------------------------------\n");
+  cupdlp_printf("--- saving to %s\n", fout);
+  cupdlp_printf("--------------------------------\n");
+  // Open a file in writing mode
+  fptr = fopen(fout, "w");
+
+  fprintf(fptr, "{");
+
+  // solver
+  fprintf(fptr, "\"solver\":\"%s\",", "cuPDLP-C");
+
+  // timers
+  fprintf(fptr, "\"nIter\":%d,", work->timers->nIter);
+  fprintf(fptr, "\"nAtyCalls\":%d,", work->timers->nAtyCalls);
+  fprintf(fptr, "\"nAxCalls\":%d,", work->timers->nAxCalls);
+  fprintf(fptr, "\"dSolvingBeg\":%f,", work->timers->dSolvingBeg);
+  fprintf(fptr, "\"dSolvingTime\":%f,", work->timers->dSolvingTime);
+  fprintf(fptr, "\"dPresolveTime\":%f,", work->timers->dPresolveTime);
+  fprintf(fptr, "\"dScalingTime\":%f,", work->timers->dScalingTime);
+#ifndef CUPDLP_CPU
+  fprintf(fptr, "\"AllocMem_CopyMatToDeviceTime\":%f,",
+          work->timers->AllocMem_CopyMatToDeviceTime);
+  fprintf(fptr, "\"CopyVecToDeviceTime\":%f,",
+          work->timers->CopyVecToDeviceTime);
+  fprintf(fptr, "\"CopyVecToHostTime\":%f,", work->timers->CopyVecToHostTime);
+  fprintf(fptr, "\"DeviceMatVecProdTime\":%f,",
+          work->timers->DeviceMatVecProdTime);
+#endif
+  // residuals
+  fprintf(fptr, "\"dPrimalObj\":%.14f,", work->resobj->dPrimalObj);
+  fprintf(fptr, "\"dDualObj\":%.14f,", work->resobj->dDualObj);
+  fprintf(fptr, "\"dPrimalFeas\":%.14f,", work->resobj->dPrimalFeas);
+  fprintf(fptr, "\"dDualFeas\":%.14f,", work->resobj->dDualFeas);
+  fprintf(fptr, "\"dPrimalObjAverage\":%.14f,",
+          work->resobj->dPrimalObjAverage);
+  fprintf(fptr, "\"dDualObjAverage\":%.14f,", work->resobj->dDualObjAverage);
+  fprintf(fptr, "\"dPrimalFeasAverage\":%.14f,",
+          work->resobj->dPrimalFeasAverage);
+  fprintf(fptr, "\"dDualFeasAverage\":%.14f,", work->resobj->dDualFeasAverage);
+  fprintf(fptr, "\"dDualityGap\":%.14f,", work->resobj->dDualityGap);
+  fprintf(fptr, "\"dDualityGapAverage\":%.14f,",
+          work->resobj->dDualityGapAverage);
+  // fprintf(fptr, "\"dComplementarity\":%.14f,",
+  // work->resobj->dComplementarity); fprintf(fptr,
+  // "\"dComplementarityAverage\":%.14f,",
+  //         work->resobj->dComplementarityAverage);
+
+  //  todo should this be added to postsolve?
+  // todo, fix dNormCost and this
+  if (work->resobj->termIterate == AVERAGE_ITERATE) {
+    fprintf(fptr, "\"dRelPrimalFeas\":%.14f,",
+            work->resobj->dPrimalFeasAverage / (1.0 + work->scaling->dNormRhs));
+    fprintf(fptr, "\"dRelDualFeas\":%.14f,",
+            work->resobj->dDualFeasAverage / (1.0 + work->scaling->dNormCost));
+    fprintf(fptr, "\"dRelDualityGap\":%.14f,", work->resobj->dRelObjGapAverage);
+  } else {
+    fprintf(fptr, "\"dRelPrimalFeas\":%.14f,",
+            work->resobj->dPrimalFeas / (1.0 + work->scaling->dNormRhs));
+    fprintf(fptr, "\"dRelDualFeas\":%.14f,",
+            work->resobj->dDualFeas / (1.0 + work->scaling->dNormCost));
+    fprintf(fptr, "\"dRelDualityGap\":%.14f,", work->resobj->dRelObjGap);
+  }
+  fprintf(fptr, "\"terminationCode\":\"%s\",",
+          termCodeNames[work->resobj->termCode]);
+  fprintf(fptr, "\"terminationIterate\":\"%s\",",
+          termIterateNames[work->resobj->termIterate]);
+  fprintf(fptr, "\"primalCode\":\"%s\",",
+          termCodeNames[work->resobj->primalCode]);
+  fprintf(fptr, "\"dualCode\":\"%s\",", termCodeNames[work->resobj->dualCode]);
+  fprintf(fptr, "\"terminationInfeasIterate\":\"%s\"",
+          termIterateNames[work->resobj->termInfeasIterate]);
+
+  fprintf(fptr, "}");
+  // Close the file
+  fclose(fptr);
+}
+
+void writeSol(const char *fout, cupdlp_int nCols, cupdlp_int nRows,
+              cupdlp_float *col_value, cupdlp_float *col_dual,
+              cupdlp_float *row_value, cupdlp_float *row_dual) {
+  FILE *fptr;
+
+  cupdlp_printf("--------------------------------\n");
+  cupdlp_printf("--- saving sol to %s\n", fout);
+  cupdlp_printf("--------------------------------\n");
+  // Open a file in writing mode
+  fptr = fopen(fout, "w");
+  fprintf(fptr, "{");
+
+  // nCols
+  fprintf(fptr, "\n");
+
+  fprintf(fptr, "\"nCols\": %d", nCols);
+
+  // nRows
+  fprintf(fptr, ",\n");
+
+  fprintf(fptr, "\"nRows\": %d", nRows);
+
+  // col value
+  fprintf(fptr, ",\n");
+
+  fprintf(fptr, "\"col_value\": [");
+  if (col_value && nCols) {
+    for (int i = 0; i < nCols - 1; ++i) {
+      fprintf(fptr, "%.14f,", col_value[i]);
+    }
+    fprintf(fptr, "%.14f", col_value[nCols - 1]);
+  }
+  fprintf(fptr, "]");
+
+  // col dual
+  fprintf(fptr, ",\n");
+  fprintf(fptr, "\"col_dual\": [");
+  if (col_dual && nCols) {
+    for (int i = 0; i < nCols - 1; ++i) {
+      fprintf(fptr, "%.14f,", col_dual[i]);
+    }
+    fprintf(fptr, "%.14f", col_dual[nCols - 1]);
+  }
+  fprintf(fptr, "]");
+
+  // row value
+  fprintf(fptr, ",\n");
+  fprintf(fptr, "\"row_value\": [");
+  if (row_value && nRows) {
+    for (int i = 0; i < nRows - 1; ++i) {
+      fprintf(fptr, "%.14f,", row_value[i]);
+    }
+    fprintf(fptr, "%.14f", row_value[nRows - 1]);
+  }
+  fprintf(fptr, "]");
+
+  // row dual
+  fprintf(fptr, ",\n");
+  fprintf(fptr, "\"row_dual\": [");
+  if (row_dual && nRows) {
+    for (int i = 0; i < nRows - 1; ++i) {
+      fprintf(fptr, "%.14f,", row_dual[i]);
+    }
+    fprintf(fptr, "%.14f", row_dual[nRows - 1]);
+  }
+  fprintf(fptr, "]");
+
+  // end writing
+  fprintf(fptr, "\n");
+  fprintf(fptr, "}");
+
+  // Close the file
+  fclose(fptr);
+}
+
+void debugPdlpIterHeaderLog(FILE* file) {
+  if (!file) return;
+  fprintf(file, "  Iter      ||Ax||     ||Aty||  ||Ax_Avg|| ||Aty_Avg|| ||x_avg||   beta    PrimalStep   DualStep \n");
+}
+
+void debugPdlpDataInitialise(struct DebugPdlpData* debug_pdlp) {
+  debug_pdlp->ax_norm = 0;
+  debug_pdlp->aty_norm = 0;
+  debug_pdlp->ax_average_norm = 0;
+  debug_pdlp->aty_average_norm = 0;
+  debug_pdlp->x_average_norm = 0;
+}
+
+void debugPdlpIterLog(FILE* file, const int iter_num, const struct DebugPdlpData* debug_pdlp, const double beta, const double primal_step, const double dual_step) {
+  if (!file) return;
+  fprintf(file, "%6d %16.12g %16.12g %16.12g %16.12g %16.12g %16.12g %16.12g %16.12g\n",
+          iter_num,
+          debug_pdlp->ax_norm,
+          debug_pdlp->aty_norm,
+          debug_pdlp->ax_average_norm,
+          debug_pdlp->aty_average_norm,
+          debug_pdlp->x_average_norm,
+          beta,
+          primal_step,
+          dual_step);
+}
+
+void debugPdlpFeasOptLog(FILE* file, 
+                         const int iter_num,
+                         const double primal_obj, const double dual_obj,
+                         const double gap, const double primal_feas, const double dual_feas,
+                         const char* type) {
+  if (!file) return;
+  fprintf(file,
+          "%6d Feasibility-optimality %s\n"
+          "  primal_obj  = %16.12g\n"
+          "  dual_obj    = %16.12g\n"
+          "  gap         = %16.12g\n"
+          "  primal_feas = %16.12g\n"
+          "  dual_feas   = %16.12g\n",
+          iter_num, type, primal_obj, dual_obj, gap, primal_feas, dual_feas);
+}
+
+void debugPdlpRestartLog(FILE* file, const int iter_num, const double current_score, const double average_score) {
+  if (!file) return;
+  fprintf(file, "Restart at iter %6d: Current Score = %.6g, Average Score = %.6g\n", iter_num, current_score, average_score);
+}
+
+void debugPdlpRestarScoretLog(FILE* file, const double weight_squared, const double primal_feas, 
+const double dual_feas, const double obj_gap) {
+  if (!file) return;
+  fprintf(file, "Restart Score: Weight^2 = %.6g, Primal Feas = %.6g, Dual Feas = %.6g, Obj Gap = %.6g\n", 
+  weight_squared, primal_feas, dual_feas, obj_gap);
+}
+
+void debugPdlpFinalSolutionLog(FILE* file, const double* x, int nCols, const double* y, int nRows) {    
+  if (!file) return;
+  fprintf(file,"Primal solution (x):\n");
+  for (int i = 0; i < nCols; ++i) {
+      fprintf(file, "x[%d]=%g\n", i, x[i]);
+  }
+  fprintf(file, "Dual solution (y):\n");
+  for (int i = 0; i < nRows; ++i) {
+      fprintf(file, "y[%d]=%g\n", i, y[i]);
+  }
+}