HyQForwardKinJacForward.h

Go to the documentation of this file.

/**********************************************************************************************************************
This file is part of the Control Toolbox (https://github.com/ethz-adrl/control-toolbox), copyright by ETH Zurich.
Licensed under the BSD-2 license (see LICENSE file in main directory)
**********************************************************************************************************************/

#pragma once

#include <ct/core/math/Derivatives.h>

namespace ct {
namespace models {
namespace HyQ {

class HyQForwardKinJacForward : public core::Derivatives<36, 24, double>
{
public:
    typedef Eigen::Matrix<double, 24, 36> JAC_TYPE;
    typedef Eigen::Matrix<double, 36, 1> X_TYPE;

    HyQForwardKinJacForward()
    {
        jac_.setZero();
        v_.fill(0.0);
    };

    HyQForwardKinJacForward(const HyQForwardKinJacForward& other)
    {
        jac_.setZero();
        v_.fill(0.0);
    }

    virtual ~HyQForwardKinJacForward(){};

    HyQForwardKinJacForward* clone() const override { return new HyQForwardKinJacForward(*this); }
    JAC_TYPE jacobian(const Eigen::VectorXd& x_in) override;

private:
    JAC_TYPE jac_;
    std::array<double, 445> v_;
};

} /* namespace HyQ */
} /* namespace models */
} /* namespace ct */