qpOASES在C++与MATLAB实现中的最优解差异排查求助

问题描述 #

• 分别在MATLAB R2022a和C++（Microsoft Visual Studio 2019）环境下使用qpOASES求解同一二次规划问题，输入的矩阵H、向量g、约束矩阵A及上下界lbA、ubA完全一致
• MATLAB求解结果经Webots仿真验证有效，C++求解结果不正确，导致Webots仿真出现性能问题
• 已提供可复现差异的示例代码，需排查C++端qpOASES的配置或使用问题并给出解决建议

可能的问题点及解决建议 #

1. 数据类型精度差异 #

• 确认C++中所有矩阵、向量变量均为double类型，避免因误用单精度（float）导致计算误差（MATLAB默认使用双精度）
• 检查qpOASES编译配置：确保编译选项中开启双精度支持，查看工程或CMake设置中的REAL_T定义是否为double（qpOASES默认双精度，但部分自定义编译可能修改为单精度）

2. qpOASES版本不一致 #

• 核对MATLAB版与C++版qpOASES的版本号，不同版本的求解器逻辑、默认参数可能存在差异，优先使用同一版本的qpOASES

3. 求解器参数与初始化差异 #

• MATLAB接口可能封装了默认初始化参数，C++端需手动配置匹配的参数：
  • 设置相同的迭代次数上限（调用setMaxIterations）
  • 对齐约束松弛参数（setRho）、可行性检查阈值（setFeasibilityCheck）等参数
  • 确保冷启动/热启动模式与MATLAB端一致

4. 矩阵内存布局差异 #

• MATLAB采用列优先存储，C++默认行优先，手动传递矩阵时需转换存储顺序：
  • 将C++中的矩阵按列优先顺序填充元素后传入qpOASES，或使用qpOASES提供的矩阵初始化接口按列赋值
  • 示例：n×n矩阵H需按H(0,0), H(1,0), ..., H(n-1,0), H(0,1), ..., H(n-1,n-1)的顺序赋值

5. 约束边界处理错误 #

• 检查C++中lbA、ubA的赋值：确保无穷边界使用std::numeric_limits<double>::infinity()，避免用过大数值替代导致边界判断错误
• 明确区分等式约束（lbA[i] == ubA[i]）与不等式约束，C++端未正确设置等式约束的上下界会导致求解逻辑偏差

6. 求解状态未校验 #

• C++端调用qpOASES求解后，必须检查返回的状态码：

  returnValue status = qp.solve();
  if (status != SUCCESSFUL_RETURN) {
      std::cout << "QP求解失败，状态码：" << status << std::endl;
  }
  

  根据状态码（如MAX_NWSR_REACHED、INFEASIBLE_PROBLEM）调整参数或初始化逻辑

内容的提问来源于stack exchange，提问作者MUHAMMAD SAQIB