10#ifndef CROCODDYL_CORE_NUMDIFF_ACTIVATION_HPP_
11#define CROCODDYL_CORE_NUMDIFF_ACTIVATION_HPP_
16#include "crocoddyl/core/fwd.hpp"
17#include "crocoddyl/core/activation-base.hpp"
21template <
typename _Scalar>
24 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
26 typedef _Scalar Scalar;
31 typedef typename MathBase::VectorXs VectorXs;
32 typedef typename MathBase::MatrixXs MatrixXs;
49 virtual void calc(
const boost::shared_ptr<ActivationDataAbstract>& data,
const Eigen::Ref<const VectorXs>& r);
54 virtual void calcDiff(
const boost::shared_ptr<ActivationDataAbstract>& data,
const Eigen::Ref<const VectorXs>& r);
61 virtual boost::shared_ptr<ActivationDataAbstract>
createData();
88 boost::shared_ptr<Base> model_;
100template <
typename _Scalar>
102 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
104 typedef _Scalar Scalar;
106 typedef typename MathBase::VectorXs VectorXs;
108 typedef typename MathBase::MatrixXs MatrixXs;
116 template <
template <
typename Scalar>
class Model>
118 :
Base(model),
dr(model->get_model()->get_nr()),
rp(model->get_model()->get_nr()), Arr_(Arr.rows(), Arr.cols()) {
122 data_0 = model->get_model()->createData();
123 const std::size_t nr = model->get_model()->get_nr();
125 for (std::size_t i = 0; i < nr; ++i) {
126 data_rp.push_back(model->get_model()->createData());
130 for (std::size_t i = 0; i < 4; ++i) {
131 data_r2p.push_back(model->get_model()->createData());
138 std::vector<boost::shared_ptr<Base> >
data_rp;
152#include "crocoddyl/core/numdiff/activation.hxx"
virtual boost::shared_ptr< ActivationDataAbstract > createData()
Create a Data object from the given model.
const boost::shared_ptr< Base > & get_model() const
Get the model_ object.
const Scalar get_disturbance() const
Get the disturbance_ object.
virtual void calc(const boost::shared_ptr< ActivationDataAbstract > &data, const Eigen::Ref< const VectorXs > &r)
void set_disturbance(const Scalar disturbance)
Set the disturbance_ object.
ActivationModelNumDiffTpl(boost::shared_ptr< Base > model)
Construct a new ActivationModelNumDiff object.
virtual void calcDiff(const boost::shared_ptr< ActivationDataAbstract > &data, const Eigen::Ref< const VectorXs > &r)
virtual ~ActivationModelNumDiffTpl()
Destroy the ActivationModelNumDiff object.
VectorXs rp
The input + the disturbance on one DoF "\f$ r^+ = rp = \int r + dr \f$".
boost::shared_ptr< Base > data_0
The data that contains the final results.
std::vector< boost::shared_ptr< Base > > data_rp
The temporary data associated with the input variation.
ActivationDataNumDiffTpl(Model< Scalar > *const model)
Construct a new ActivationDataNumDiff object.
std::vector< boost::shared_ptr< Base > > data_r2p
The temporary data associated with the input variation.