fatrop_conic_interface.hpp

/*
 *    This file is part of CasADi.
 *
 *    CasADi -- A symbolic framework for dynamic optimization.
 *    Copyright (C) 2010-2023 Joel Andersson, Joris Gillis, Moritz Diehl,
 *                            KU Leuven. All rights reserved.
 *    Copyright (C) 2011-2014 Greg Horn
 *
 *    CasADi is free software; you can redistribute it and/or
 *    modify it under the terms of the GNU Lesser General Public
 *    License as published by the Free Software Foundation; either
 *    version 3 of the License, or (at your option) any later version.
 *
 *    CasADi is distributed in the hope that it will be useful,
 *    but WITHOUT ANY WARRANTY; without even the implied warranty of
 *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *    Lesser General Public License for more details.
 *
 *    You should have received a copy of the GNU Lesser General Public
 *    License along with CasADi; if not, write to the Free Software
 *    Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */
 
 
#ifndef CASADI_FATROP_CONIC_INTERFACE_HPP
#define CASADI_FATROP_CONIC_INTERFACE_HPP
 
#include "casadi/core/conic_impl.hpp"
#include "casadi/core/linsol.hpp"
#include <casadi/interfaces/fatrop/casadi_conic_fatrop_export.h>
 
namespace casadi {
  #include "fatrop_conic_runtime.hpp"
}
 
#include <ocp/OCPAbstract.hpp>
#include <ocp/StageOCPApplication.hpp>
#include <ocp/OCPCInterface.h>
 
namespace casadi {
 
  // Forward declaration
  class FatropConicInterface;
  struct  FatropConicMemory : public ConicMemory {
    // Problem data structure
    casadi_fatrop_conic_data<double> d;
 
    // unused: lamg, xs, us, workspace, stats
 
    FatropConicMemory();
 
    ~FatropConicMemory();
  };
 
  class  FatropConicInterface : public Conic {
  public:
    explicit FatropConicInterface();
 
    static Conic* creator(const std::string& name,
                          const std::map<std::string, Sparsity>& st) {
      return new FatropConicInterface(name, st);
    }
 
    explicit FatropConicInterface(const std::string& name,
                              const std::map<std::string, Sparsity>& st);
 
    Dict get_stats(void* mem) const override;
 
    ~FatropConicInterface() override;
 
    // Get name of the plugin
    const char* plugin_name() const override { return "fatrop";}
 
    // Get name of the class
    std::string class_name() const override { return "FatropConicInterface";}
 
 
    static const Options options_;
    const Options& get_options() const override { return options_;}
 
    void set_fatrop_conic_prob();
 
    void init(const Dict& opts) override;
 
    void* alloc_mem() const override { return new FatropConicMemory();}
 
    int init_mem(void* mem) const override;
 
    void free_mem(void *mem) const override { delete static_cast<FatropConicMemory*>(mem);}
 
    void set_work(void* mem, const double**& arg, double**& res,
                          casadi_int*& iw, double*& w) const override;
    void set_temp(void* mem, const double** arg, double** res,
                          casadi_int* iw, double* w) const override;
 
    int solve(const double** arg, double** res,
      casadi_int* iw, double* w, void* mem) const override;
 
    static void mproject(double factor, const double* x, const casadi_int* sp_x,
                         double* y, const casadi_int* sp_y, double* w);
 
    static void dense_transfer(double factor, const double* x, const casadi_int* sp_x, double* y,
                               const casadi_int* sp_y, double* w);
 
    static const std::string meta_doc;
 
    void serialize_body(SerializingStream &s) const override;
 
    static ProtoFunction* deserialize(DeserializingStream& s) {
      return new FatropConicInterface(s);
    }
 
    friend class CasadiStructuredQP;
 
  public:
    explicit FatropConicInterface(DeserializingStream& s);
 
    // Memory structure
    casadi_fatrop_conic_prob<double> p_;
 
    static Sparsity blocksparsity(casadi_int rows, casadi_int cols,
                                   const std::vector<casadi_ocp_block>& blocks, bool eye=false);
    static void blockptr(std::vector<double *>& vs, std::vector<double>& v,
      const std::vector<casadi_ocp_block>& blocks, bool eye=false);
    Sparsity Asp_, Bsp_, Csp_, Dsp_, Isp_, Rsp_, Ssp_, Qsp_, bsp_, lugsp_, usp_, xsp_;
    Sparsity theirs_xsp_, theirs_usp_, theirs_Xsp_, theirs_Usp_;
    Sparsity lamg_gapsp_;
    Sparsity lam_cusp_, pisp_;
 
    Sparsity ABsp_, CDsp_, RSQsp_;
 
    std::vector< casadi_ocp_block > R_blocks, S_blocks, Q_blocks;
    std::vector< casadi_ocp_block > b_blocks, lug_blocks;
    std::vector< casadi_ocp_block > u_blocks, x_blocks;
    std::vector< casadi_ocp_block > lam_ul_blocks, lam_xl_blocks,
      lam_uu_blocks, lam_xu_blocks, lam_cl_blocks;
    std::vector< casadi_ocp_block > lam_cu_blocks, A_blocks, B_blocks,
      C_blocks, D_blocks, I_blocks;
 
 
    std::vector< casadi_ocp_block > AB_blocks, CD_blocks, RSQ_blocks;
 
    std::vector<int> nxs_;
    std::vector<int> nus_;
    std::vector<int> ngs_;
    std::vector<int> zeros_;
    casadi_int N_;
    casadi_int print_level_;
 
 
    // An enum field for the structure detection
    enum structure_detection {
      STRUCTURE_NONE,
      STRUCTURE_AUTO,
      STRUCTURE_MANUAL
    };
    structure_detection structure_detection_;
 
    std::vector<casadi_int> AB_offsets_, CD_offsets_, RSQ_offsets_;
 
    bool warm_start_;
    double inf_;
 
  };
 
 
 
} // namespace casadi
 
#endif // CASADI_FATROP_CONIC_INTERFACE_HPP