bspline.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_BSPLINE_HPP
#define CASADI_BSPLINE_HPP
 
#include "mx_node.hpp"
#include <map>
#include <stack>
 
 
namespace casadi {
  class CASADI_EXPORT BSplineCommon : public MXNode {
  public:
 
    BSplineCommon(const std::vector<double>& knots,
            const std::vector<casadi_int>& offset,
            const std::vector<casadi_int>& degree,
            casadi_int m,
            const std::vector<casadi_int>& lookup_mode);
 
    ~BSplineCommon() override {}
 
    static void prepare(casadi_int m, const std::vector<casadi_int>& offset,
      const std::vector<casadi_int>& degree, casadi_int &coeffs_size,
      std::vector<casadi_int>& coeffs_dims, std::vector<casadi_int>& strides);
 
    static casadi_int get_coeff_size(casadi_int m, const std::vector<casadi_int>& offset,
      const std::vector<casadi_int>& degree);
 
    std::vector<double> knots_;
    std::vector<casadi_int> offset_;
    std::vector<casadi_int> degree_;
    casadi_int m_;
    std::vector<casadi_int> lookup_mode_;
 
    // Derived fields
    std::vector<casadi_int> strides_;
    std::vector<casadi_int> coeffs_dims_;
    casadi_int coeffs_size_;
 
    mutable MX jac_cache_;
 
    virtual MX jac_cached() const = 0;
 
    static size_t n_iw(const std::vector<casadi_int> &degree);
 
    static size_t n_w(const std::vector<casadi_int> &degree);
 
    size_t sz_iw() const override;
 
    size_t sz_w() const override;
 
    casadi_int op() const override { return OP_BSPLINE;}
 
    void ad_forward(const std::vector<std::vector<MX> >& fseed,
                         std::vector<std::vector<MX> >& fsens) const override;
 
    void ad_reverse(const std::vector<std::vector<MX> >& aseed,
                         std::vector<std::vector<MX> >& asens) const override;
 
    void generate(CodeGenerator& g,
                  const std::vector<casadi_int>& arg,
                  const std::vector<casadi_int>& res) const override;
 
    virtual std::string generate(CodeGenerator& g,
                  const std::vector<casadi_int>& arg) const = 0;
 
    static MXNode* deserialize(DeserializingStream& s);
 
    template<class M>
    M derivative_coeff(casadi_int i, const M& coeffs) const;
 
    template<class T>
    MX jac(const MX& x, const T& coeffs) const;
 
    void serialize_body(SerializingStream& s) const override;
 
  protected:
 
    explicit BSplineCommon(DeserializingStream& s);
 
  };
 
  class CASADI_EXPORT BSpline : public BSplineCommon {
  public:
 
    static MX create(const MX& x, const std::vector< std::vector<double> >& knots,
          const std::vector<double>& coeffs,
          const std::vector<casadi_int>& degree,
          casadi_int m,
          const Dict& opts);
 
    BSpline(const MX& x, const std::vector<double>& knots,
            const std::vector<casadi_int>& offset,
            const std::vector<double>& coeffs,
            const std::vector<casadi_int>& degree,
            casadi_int m,
            const std::vector<casadi_int>& lookup_mode);
 
    ~BSpline() override {}
 
    int eval(const double** arg, double** res, casadi_int* iw, double* w) const override;
 
    void eval_mx(const std::vector<MX>& arg, std::vector<MX>& res) const override;
 
    std::string generate(CodeGenerator& g,
                  const std::vector<casadi_int>& arg) const override;
 
    std::string disp(const std::vector<std::string>& arg) const override;
 
    // Numeric coefficients
    std::vector<double> coeffs_;
 
    MX jac_cached() const override;
 
    static DM dual(const std::vector<double>& x,
          const std::vector< std::vector<double> >& knots,
          const std::vector<casadi_int>& degree,
          const Dict& opts);
    void serialize_body(SerializingStream& s) const override;
    void serialize_type(SerializingStream& s) const override;
 
    explicit BSpline(DeserializingStream& s);
  };
 
  // Symbolic coefficients
  class CASADI_EXPORT BSplineParametric : public BSplineCommon {
  public:
    static MX create(const MX& x, const MX& coeffs,
          const std::vector< std::vector<double> >& knots,
          const std::vector<casadi_int>& degree,
          casadi_int m,
          const Dict& opts);
 
    BSplineParametric(const MX& x, const MX& coeffs,
            const std::vector<double>& knots,
            const std::vector<casadi_int>& offset,
            const std::vector<casadi_int>& degree,
            casadi_int m,
            const std::vector<casadi_int>& lookup_mode);
 
    ~BSplineParametric() override {}
 
    int eval(const double** arg, double** res, casadi_int* iw, double* w) const override;
 
    void eval_mx(const std::vector<MX>& arg, std::vector<MX>& res) const override;
 
    MX jac_cached() const override;
 
    std::string generate(CodeGenerator& g,
                  const std::vector<casadi_int>& arg) const override;
 
    std::string disp(const std::vector<std::string>& arg) const override;
 
    void serialize_type(SerializingStream& s) const override;
 
    explicit BSplineParametric(DeserializingStream& s) : BSplineCommon(s) {}
  };
 
} // namespace casadi
 
#endif // CASADI_BSPLINE_HPP