9 #ifndef CROCODDYL_MULTIBODY_ACTIONS_FREE_FWDDYN_HPP_
10 #define CROCODDYL_MULTIBODY_ACTIONS_FREE_FWDDYN_HPP_
14 #ifdef PINOCCHIO_WITH_CPPAD_SUPPORT
15 #include <pinocchio/codegen/cppadcg.hpp>
18 #include "crocoddyl/multibody/fwd.hpp"
19 #include "crocoddyl/core/diff-action-base.hpp"
20 #include "crocoddyl/core/actuation-base.hpp"
21 #include "crocoddyl/multibody/data/multibody.hpp"
22 #include "crocoddyl/multibody/states/multibody.hpp"
23 #include "crocoddyl/multibody/costs/cost-sum.hpp"
27 template <
typename _Scalar>
30 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
32 typedef _Scalar Scalar;
40 typedef typename MathBase::VectorXs VectorXs;
41 typedef typename MathBase::MatrixXs MatrixXs;
44 boost::shared_ptr<ActuationModelAbstract> actuation,
45 boost::shared_ptr<CostModelSum> costs);
48 virtual void calc(
const boost::shared_ptr<DifferentialActionDataAbstract>& data,
const Eigen::Ref<const VectorXs>& x,
49 const Eigen::Ref<const VectorXs>& u);
50 virtual void calcDiff(
const boost::shared_ptr<DifferentialActionDataAbstract>& data,
51 const Eigen::Ref<const VectorXs>& x,
const Eigen::Ref<const VectorXs>& u);
52 virtual boost::shared_ptr<DifferentialActionDataAbstract>
createData();
53 virtual bool checkData(
const boost::shared_ptr<DifferentialActionDataAbstract>& data);
55 const boost::shared_ptr<ActuationModelAbstract>& get_actuation()
const;
56 const boost::shared_ptr<CostModelSum>& get_costs()
const;
57 pinocchio::ModelTpl<Scalar>& get_pinocchio()
const;
58 const VectorXs& get_armature()
const;
59 void set_armature(
const VectorXs& armature);
71 boost::shared_ptr<ActuationModelAbstract> actuation_;
72 boost::shared_ptr<CostModelSum> costs_;
73 pinocchio::ModelTpl<Scalar>& pinocchio_;
78 template <
typename _Scalar>
80 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
81 typedef _Scalar Scalar;
84 typedef typename MathBase::VectorXs VectorXs;
85 typedef typename MathBase::MatrixXs MatrixXs;
87 template <
template <
typename Scalar>
class Model>
90 pinocchio(pinocchio::DataTpl<Scalar>(model->get_pinocchio())),
91 multibody(&pinocchio, model->get_actuation()->createData()),
92 costs(model->get_costs()->createData(&multibody)),
93 Minv(model->get_state()->get_nv(), model->get_state()->get_nv()),
94 u_drift(model->get_nu()),
95 dtau_dx(model->get_nu(), model->get_state()->get_ndx()) {
96 costs->shareMemory(
this);
102 pinocchio::DataTpl<Scalar> pinocchio;
104 boost::shared_ptr<CostDataSumTpl<Scalar> > costs;
126 #include <crocoddyl/multibody/actions/free-fwddyn.hxx>
128 #endif // CROCODDYL_MULTIBODY_ACTIONS_FREE_FWDDYN_HPP_