9 #ifndef CROCODDYL_CORE_ACTIONS_UNICYCLE_HPP_
10 #define CROCODDYL_CORE_ACTIONS_UNICYCLE_HPP_
14 #include "crocoddyl/core/fwd.hpp"
15 #include "crocoddyl/core/action-base.hpp"
16 #include "crocoddyl/core/states/euclidean.hpp"
19 template <
typename _Scalar>
22 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
24 typedef _Scalar Scalar;
29 typedef typename MathBase::VectorXs VectorXs;
30 typedef typename MathBase::Vector2s Vector2s;
35 virtual void calc(
const boost::shared_ptr<ActionDataAbstract>& data,
const Eigen::Ref<const VectorXs>& x,
36 const Eigen::Ref<const VectorXs>& u);
37 virtual void calcDiff(
const boost::shared_ptr<ActionDataAbstract>& data,
const Eigen::Ref<const VectorXs>& x,
38 const Eigen::Ref<const VectorXs>& u);
39 virtual boost::shared_ptr<ActionDataAbstract>
createData();
40 virtual bool checkData(
const boost::shared_ptr<ActionDataAbstract>& data);
42 const Vector2s& get_cost_weights()
const;
43 void set_cost_weights(
const Vector2s& weights);
45 Scalar get_dt()
const;
46 void set_dt(
const Scalar dt);
58 Vector2s cost_weights_;
62 template <
typename _Scalar>
64 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
66 typedef _Scalar Scalar;
80 template <
template <
typename Scalar>
class Model>
82 Fx.diagonal().array() = Scalar(1.);
91 #include "crocoddyl/core/actions/unicycle.hxx"
93 #endif // CROCODDYL_CORE_ACTIONS_UNICYCLE_HPP_