使用OSQP解决二次凸优化(QP)问题

2023-12-08 17:18

本文主要是介绍使用OSQP解决二次凸优化(QP)问题,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

什么是二次凸优化问题

可以转化成满足如下方程的优化问题B被称为二次凸优化(QP)问题。

min_x 0.5 * x'Px + q'x
s.t.  l <= Ax <= u

其中P是对称正定矩阵。所以目标函数的全局最小值就是其极小值。在二维的情况下,目标函数的图像类似下面的图。这样大概有一个印象就好。
在这里插入图片描述
约束类型可以是等式约束和不等式约束。
当需要设置等式约束时可以将需要相等的行设置为l[i] == u[i]
单侧的不等式约束,可以将最小或最大侧设置成无穷小或无穷大。

如何构造二次凸优化(QP)问题

这是一个比较大的问题。将很多实际的问题进行数学建模,然后转成凸优化问题。这样就能解了。这里仅说明一下这样的思路。

如何解二次凸优化(QP)问题

这里介绍如何使用OSQP库进行求解。
我已经将依赖的库合在一起了。可以在这里下载https://github.com/shoufei403/OSQP
使用osqp库和osqp-eigen库。osqp-eigen库是对osqp库的封装,其提供了更好用的eigen接口。

主要使用的接口如下:

    // set the initial data of the QP solver//矩阵A为m*n矩阵solver.data()->setNumberOfVariables(NumberOfVariables); //设置A矩阵的列数,即nsolver.data()->setNumberOfConstraints(NumberOfConstraints); //设置A矩阵的行数,即mif(!solver.data()->setHessianMatrix(hessian)) return 1;//设置P矩阵if(!solver.data()->setGradient(gradient)) return 1; //设置q or f矩阵。当没有时设置为全0向量if(!solver.data()->setLinearConstraintsMatrix(linearMatrix)) return 1;//设置线性约束的A矩阵if(!solver.data()->setLowerBound(lowerBound)) return 1;//设置下边界if(!solver.data()->setUpperBound(upperBound)) return 1;//设置上边界

下面的实例来源于https://ww2.mathworks.cn/help/optim/ug/quadprog.html?s_tid=srchtitle

  • 具有线性约束的二次规划
    在这里插入图片描述
    hessian.resize(2,2);hessian.insert(0,0) = 1;hessian.insert(1,0) = -1;hessian.insert(0,1) = -1;hessian.insert(1,1) = 2;std::cout << "hessian:" << std::endl << hessian << std::endl;gradient.resize(2);gradient << -2, -6;std::cout << "gradient:" << std::endl << gradient << std::endl;linearMatrix.resize(3,2);linearMatrix.insert(0,0) = 1;linearMatrix.insert(0,1) = 1;linearMatrix.insert(1,0) = -1;linearMatrix.insert(1,1) = 2;linearMatrix.insert(2,0) = 2;linearMatrix.insert(2,1) = 1;std::cout << "linearMatrix:" << std::endl << linearMatrix << std::endl;lowerBound.resize(3);lowerBound << -OsqpEigen::INFTY, -OsqpEigen::INFTY, -OsqpEigen::INFTY;std::cout << "lowerBound:" << std::endl << lowerBound << std::endl;upperBound.resize(3);upperBound << 2, 2, 3;std::cout << "upperBound:" << std::endl << upperBound << std::endl;int NumberOfVariables = 2; //A矩阵的列数int NumberOfConstraints = 3; //A矩阵的行数
  • 具有线性等式约束的二次规划
    在这里插入图片描述
    hessian.resize(2,2);hessian.insert(0,0) = 1;hessian.insert(1,0) = -1;hessian.insert(0,1) = -1;hessian.insert(1,1) = 2;std::cout << "hessian:" << std::endl << hessian << std::endl;gradient.resize(2);gradient << -2, -6;std::cout << "gradient:" << std::endl << gradient << std::endl;linearMatrix.resize(1,2);linearMatrix.insert(0,0) = 1;linearMatrix.insert(0,1) = 1;std::cout << "linearMatrix:" << std::endl << linearMatrix << std::endl;lowerBound.resize(1);lowerBound << 0;std::cout << "lowerBound:" << std::endl << lowerBound << std::endl;upperBound.resize(1);upperBound << 0;std::cout << "upperBound:" << std::endl << upperBound << std::endl;int NumberOfVariables = 2; //A矩阵的列数int NumberOfConstraints = 1; //A矩阵的行数
  • 具有线性约束和边界的二次最小化
    在这里插入图片描述
    该问题即包含了等式约束也包含了不等式约束。写成矩阵形式如下:
    [ 0 0 0 0.5 ] < = [ 1 0 0 0 1 0 0 0 1 1 1 1 ] [ x 1 x 2 x 3 ] < = [ 1 1 1 0.5 ] \begin{bmatrix} 0\\ 0\\ 0\\ 0.5 \end{bmatrix} <= \begin{bmatrix} 1& 0& 0\\ 0& 1& 0\\ 0& 0& 1\\ 1& 1& 1 \end{bmatrix} \begin{bmatrix} x_1\\ x_2\\ x_3 \end{bmatrix} <=\begin{bmatrix} 1\\ 1\\ 1\\ 0.5 \end{bmatrix} 0000.5<=100101010011x1x2x3<=1110.5
    hessian.resize(3,3);hessian.insert(0,0) = 1;hessian.insert(1,0) = -1;hessian.insert(2,0) = 1;hessian.insert(0,1) = -1;hessian.insert(1,1) = 2;hessian.insert(2,1) = -2;hessian.insert(0,2) = 1;hessian.insert(1,2) = -2;hessian.insert(2,2) = 4;std::cout << "hessian:" << std::endl << hessian << std::endl;gradient.resize(3);gradient << 2, -3, 1;std::cout << "gradient:" << std::endl << gradient << std::endl;linearMatrix.resize(4,3);linearMatrix.insert(0,0) = 1;linearMatrix.insert(1,0) = 0;linearMatrix.insert(2,0) = 0;linearMatrix.insert(3,0) = 1;linearMatrix.insert(0,1) = 0;linearMatrix.insert(1,1) = 1;linearMatrix.insert(2,1) = 0;linearMatrix.insert(3,1) = 1;linearMatrix.insert(0,2) = 0;linearMatrix.insert(1,2) = 0;linearMatrix.insert(2,2) = 1;linearMatrix.insert(3,2) = 1;std::cout << "linearMatrix:" << std::endl << linearMatrix << std::endl;lowerBound.resize(4);lowerBound << 0, 0, 0, 0.5;std::cout << "lowerBound:" << std::endl << lowerBound << std::endl;upperBound.resize(4);upperBound << 1, 1, 1, 0.5;std::cout << "upperBound:" << std::endl << upperBound << std::endl;int NumberOfVariables = 3; //A矩阵的列数int NumberOfConstraints = 4; //A矩阵的行数

遇到的问题

  1. 编译osqp-eigen库时报下面的错误:
CMake Error at cmake/OsqpEigenDependencies.cmake:12 (find_package):Could not find a configuration file for package "Eigen3" that is compatiblewith requested version "3.2.92".The following configuration files were considered but not accepted:/usr/lib/cmake/eigen3/Eigen3Config.cmake, version: unknownCall Stack (most recent call first):CMakeLists.txt:63 (include)

解决措施:需要将原来旧的eigen库删掉,重新按照最新的eigen库。

sudo rm -rf /usr/include/eigen3
sudo rm -rf /usr/lib/cmake/eigen3

重新安装eigen,注意要安装到原来的位置/usr/include,不然catkin_make会报错。

mkdir build
cd build
cmake .. -DCMAKE_INSTALL_PREFIX=/usr
sudo make install
  1. 编译osqp-eigen库时报target_compile_features specified unknown feature cxx_std_14 for target错误。
    解决措施:将cmake升级到3.14版本后可以正常编译。但是sudo apt remove cmake时,把很多ros的库也删掉了,导致roscore都运行不了。
    其实将CMakeList.txt文件更改一下就好了:
add_definitions(-std=c++14)  #添加这一行
#target_compile_features(${LIBRARY_TARGET_NAME} PUBLIC cxx_std_14)  #注释这一行
  1. 使用osqp-eigen库时出现这样的问题:
In file included from /usr/local/include/OsqpEigen/OsqpEigen.h:10:0,from /catkin_ws/src/MinimumSnap-Trajectory-Generation/waypoint_trajectory_generator/src/trajectory_generator_osqp.cpp:10:
/usr/local/include/OsqpEigen/Constants.hpp:12:18: fatal error: osqp.h: No such file or directory

这是因为头文件的包含路径有问题。按下图方式更改osqp-eigen库头文件,再重新编译安装。
在这里插入图片描述
Solver.tpp文件中对osqp库头文件的引用要改成下面的方式

#include <osqp/auxil.h>
#include <osqp/scaling.h>
  1. 运行程序链接osqp库时报错。error while loading shared libraries: libosqp.so: cannot open shared object file: No such file or directory
    解决措施:需要添加相应的链接地址
    ···
    sudo vim /etc/ld.so.conf
    ···
    在里面添加一行
/usr/local/lib

最后再执行一下下面的语句

sudo  /sbin/ldconfig
  1. 运行链接了osqp库和OsqpEigen的程序时,总是会报Segmentation fault (core dumped)
    发现是CMakeLists的写法不同导致的。
    原来自己的写法是:
set(ADDITIONAL_CXX_FLAG "-Wall -O3 -march=native") //事实上是这一条不能加
target_link_libraries(trajectory_generator_node_testqdldlosqpOsqpEigen
)

官方的例子是这样写的。

cmake_minimum_required(VERSION 3.1)set (CMAKE_CXX_STANDARD 11)project(OsqpEigen-Example)find_package(OsqpEigen)
find_package(Eigen3)include_directories(SYSTEM ${EIGEN3_INCLUDE_DIR})#MPCExample
add_executable(MPCExample src/MPCExample.cpp)
target_link_libraries(MPCExample OsqpEigen::OsqpEigen)#Simple Example
add_executable(SimpleExample src/simpleqp_example.cpp)
target_link_libraries(SimpleExample OsqpEigen::OsqpEigen)

参照官方的例子写就正常了。

关注公众号《首飞》回复“机器人”获取精心推荐的C/C++,Python,Docker,Qt,ROS1/2等机器人行业常用技术资料。

这篇关于使用OSQP解决二次凸优化(QP)问题的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/470686

相关文章

springboot security使用jwt认证方式

《springbootsecurity使用jwt认证方式》:本文主要介绍springbootsecurity使用jwt认证方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地... 目录前言代码示例依赖定义mapper定义用户信息的实体beansecurity相关的类提供登录接口测试提供一

go中空接口的具体使用

《go中空接口的具体使用》空接口是一种特殊的接口类型,它不包含任何方法,本文主要介绍了go中空接口的具体使用,具有一定的参考价值,感兴趣的可以了解一下... 目录接口-空接口1. 什么是空接口?2. 如何使用空接口?第一,第二,第三,3. 空接口几个要注意的坑坑1:坑2:坑3:接口-空接口1. 什么是空接

springboot security快速使用示例详解

《springbootsecurity快速使用示例详解》:本文主要介绍springbootsecurity快速使用示例,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝... 目录创www.chinasem.cn建spring boot项目生成脚手架配置依赖接口示例代码项目结构启用s

Python如何使用__slots__实现节省内存和性能优化

《Python如何使用__slots__实现节省内存和性能优化》你有想过,一个小小的__slots__能让你的Python类内存消耗直接减半吗,没错,今天咱们要聊的就是这个让人眼前一亮的技巧,感兴趣的... 目录背景:内存吃得满满的类__slots__:你的内存管理小助手举个大概的例子:看看效果如何?1.

一文详解SpringBoot响应压缩功能的配置与优化

《一文详解SpringBoot响应压缩功能的配置与优化》SpringBoot的响应压缩功能基于智能协商机制,需同时满足很多条件,本文主要为大家详细介绍了SpringBoot响应压缩功能的配置与优化,需... 目录一、核心工作机制1.1 自动协商触发条件1.2 压缩处理流程二、配置方案详解2.1 基础YAML

java中使用POI生成Excel并导出过程

《java中使用POI生成Excel并导出过程》:本文主要介绍java中使用POI生成Excel并导出过程,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录需求说明及实现方式需求完成通用代码版本1版本2结果展示type参数为atype参数为b总结注:本文章中代码均为

Spring事务中@Transactional注解不生效的原因分析与解决

《Spring事务中@Transactional注解不生效的原因分析与解决》在Spring框架中,@Transactional注解是管理数据库事务的核心方式,本文将深入分析事务自调用的底层原理,解释为... 目录1. 引言2. 事务自调用问题重现2.1 示例代码2.2 问题现象3. 为什么事务自调用会失效3

mysql出现ERROR 2003 (HY000): Can‘t connect to MySQL server on ‘localhost‘ (10061)的解决方法

《mysql出现ERROR2003(HY000):Can‘tconnecttoMySQLserveron‘localhost‘(10061)的解决方法》本文主要介绍了mysql出现... 目录前言:第一步:第二步:第三步:总结:前言:当你想通过命令窗口想打开mysql时候发现提http://www.cpp

Spring Boot3虚拟线程的使用步骤详解

《SpringBoot3虚拟线程的使用步骤详解》虚拟线程是Java19中引入的一个新特性,旨在通过简化线程管理来提升应用程序的并发性能,:本文主要介绍SpringBoot3虚拟线程的使用步骤,... 目录问题根源分析解决方案验证验证实验实验1:未启用keep-alive实验2:启用keep-alive扩展建

SpringBoot启动报错的11个高频问题排查与解决终极指南

《SpringBoot启动报错的11个高频问题排查与解决终极指南》这篇文章主要为大家详细介绍了SpringBoot启动报错的11个高频问题的排查与解决,文中的示例代码讲解详细,感兴趣的小伙伴可以了解一... 目录1. 依赖冲突:NoSuchMethodError 的终极解法2. Bean注入失败:No qu