QuadraticProgram.hpp

Go to the documentation of this file.

#ifndef WBC_CORE_QUADRATIC_PROGRAM_HPP
#define WBC_CORE_QUADRATIC_PROGRAM_HPP
 
#include <Eigen/Core>
#include <vector>
 
namespace wbc{

struct QuadraticProgram{
 
    int nq;                 
    int neq;                
    int nin;                
 
    bool bounded;            
 
    Eigen::MatrixXd H;       
    Eigen::VectorXd g;       
    Eigen::MatrixXd A;       
    Eigen::VectorXd b;       
    Eigen::MatrixXd C;       
    Eigen::VectorXd lower_y; 
    Eigen::VectorXd upper_y; 
    Eigen::VectorXd lower_x; 
    Eigen::VectorXd upper_x; 
    Eigen::VectorXd Wy;      

    void resize(uint nq, uint neq, uint nin, bool bounds);

    bool isValid() const;

    void print() const;
 
};

struct HierarchicalQP{
    std::vector<QuadraticProgram> prios;           
    Eigen::VectorXd Wq;                            
 
    size_t size() const {
        return prios.size();
    }
    QuadraticProgram& operator[](int i) {
        return prios[i];
    }
    const QuadraticProgram& operator[](int i) const {
        return prios[i];
    }
    void operator<<(QuadraticProgram& qp) {
        prios.push_back(qp);
    }
    void resize(const size_t &n){prios.resize(n);}
};
 
}
 
#endif // WBC_CORE_QUADRATIC_PROGRAM_HPP