Re-add setVariables

tesseract-robotics · Nov 28, 2023 · f70c3d2 · f70c3d2
1 parent 0bc3609
commit f70c3d2
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/trajopt_optimizers/trajopt_sqp/src/trust_region_sqp_solver.cpp b/trajopt_optimizers/trajopt_sqp/src/trust_region_sqp_solver.cpp
@@ -383,6 +383,8 @@ SQPStatus TrustRegionSQPSolver::solveQPProblem()
   }
   else
   {
+    qp_problem->setVariables(results_.best_var_vals.data());
+
     CONSOLE_BRIDGE_logError("Solver Failure");
     return SQPStatus::QP_SOLVER_ERROR;
   }