crocoddyl
1.8.0
Contact RObot COntrol by Differential DYnamic programming Library (Crocoddyl)
frame-velocity.hpp
1
// BSD 3-Clause License
3
//
4
// Copyright (C) 2019-2021, LAAS-CNRS, University of Edinburgh, INRIA
5
// Copyright note valid unless otherwise stated in individual files.
6
// All rights reserved.
8
9
#ifndef CROCODDYL_MULTIBODY_COSTS_FRAME_VELOCITY_HPP_
10
#define CROCODDYL_MULTIBODY_COSTS_FRAME_VELOCITY_HPP_
11
12
#include "crocoddyl/multibody/fwd.hpp"
13
#include "crocoddyl/core/costs/residual.hpp"
14
#include "crocoddyl/multibody/states/multibody.hpp"
15
#include "crocoddyl/multibody/residuals/frame-velocity.hpp"
16
#include "crocoddyl/multibody/data/multibody.hpp"
17
#include "crocoddyl/multibody/frames.hpp"
18
#include "crocoddyl/core/utils/exception.hpp"
19
20
namespace
crocoddyl {
21
38
template
<
typename
_Scalar>
39
class
CostModelFrameVelocityTpl
:
public
CostModelResidualTpl
<_Scalar> {
40
public
:
41
EIGEN_MAKE_ALIGNED_OPERATOR_NEW
42
43
typedef
_Scalar Scalar;
44
typedef
MathBaseTpl<Scalar>
MathBase
;
45
typedef
CostModelResidualTpl<Scalar>
Base
;
46
typedef
CostDataFrameVelocityTpl<Scalar>
Data
;
47
typedef
StateMultibodyTpl<Scalar>
StateMultibody
;
48
typedef
ActivationModelAbstractTpl<Scalar>
ActivationModelAbstract
;
49
typedef
ResidualModelFrameVelocityTpl<Scalar>
ResidualModelFrameVelocity
;
50
typedef
FrameMotionTpl<Scalar>
FrameMotion
;
51
typedef
typename
MathBase::VectorXs VectorXs;
52
61
CostModelFrameVelocityTpl
(boost::shared_ptr<StateMultibody> state,
62
boost::shared_ptr<ActivationModelAbstract> activation,
const
FrameMotion
& Fref,
63
const
std::size_t nu);
64
74
CostModelFrameVelocityTpl
(boost::shared_ptr<StateMultibody> state,
75
boost::shared_ptr<ActivationModelAbstract> activation,
const
FrameMotion
& Fref);
76
86
CostModelFrameVelocityTpl
(boost::shared_ptr<StateMultibody> state,
const
FrameMotion
& Fref,
const
std::size_t nu);
87
97
CostModelFrameVelocityTpl
(boost::shared_ptr<StateMultibody> state,
const
FrameMotion
& Fref);
98
virtual
~
CostModelFrameVelocityTpl
();
99
100
protected
:
104
virtual
void
get_referenceImpl
(
const
std::type_info& ti,
void
* pv);
105
109
virtual
void
set_referenceImpl
(
const
std::type_info& ti,
const
void
* pv);
110
111
using
Base::activation_
;
112
using
Base::nu_
;
113
using
Base::residual_
;
114
using
Base::state_
;
115
using
Base::unone_
;
116
117
private
:
118
FrameMotion
vref_;
119
};
120
121
}
// namespace crocoddyl
122
123
/* --- Details -------------------------------------------------------------- */
124
/* --- Details -------------------------------------------------------------- */
125
/* --- Details -------------------------------------------------------------- */
126
#include "crocoddyl/multibody/costs/frame-velocity.hxx"
127
128
#endif // CROCODDYL_MULTIBODY_COSTS_FRAME_VELOCITY_HPP_
crocoddyl::CostModelResidualTpl
Residual-based cost.
Definition:
residual.hpp:36
crocoddyl::CostModelFrameVelocityTpl::CostModelFrameVelocityTpl
CostModelFrameVelocityTpl(boost::shared_ptr< StateMultibody > state, boost::shared_ptr< ActivationModelAbstract > activation, const FrameMotion &Fref, const std::size_t nu)
Initialize the frame velocity cost model.
crocoddyl::MathBaseTpl< Scalar >
crocoddyl::CostModelAbstractTpl::unone_
VectorXs unone_
No control vector.
Definition:
cost-base.hpp:238
crocoddyl::CostModelAbstractTpl::activation_
boost::shared_ptr< ActivationModelAbstract > activation_
Activation model.
Definition:
cost-base.hpp:235
crocoddyl::CostModelAbstractTpl
Abstract class for cost models.
Definition:
cost-base.hpp:49
crocoddyl::CostModelFrameVelocityTpl::get_referenceImpl
virtual void get_referenceImpl(const std::type_info &ti, void *pv)
Return the frame velocity reference.
crocoddyl::ResidualModelFrameVelocityTpl
Frame velocity residual.
Definition:
fwd.hpp:147
crocoddyl::CostModelFrameVelocityTpl::set_referenceImpl
virtual void set_referenceImpl(const std::type_info &ti, const void *pv)
Modify the frame velocity reference.
crocoddyl::CostModelFrameVelocityTpl
Frame velocity cost.
Definition:
frame-velocity.hpp:39
crocoddyl::StateMultibodyTpl
State multibody representation.
Definition:
fwd.hpp:300
crocoddyl::CostModelAbstractTpl::state_
boost::shared_ptr< StateAbstract > state_
State description.
Definition:
cost-base.hpp:234
crocoddyl::CostDataResidualTpl
Definition:
residual.hpp:113
crocoddyl::CostModelAbstractTpl::residual_
boost::shared_ptr< ResidualModelAbstract > residual_
Residual model.
Definition:
cost-base.hpp:236
crocoddyl::ActivationModelAbstractTpl< Scalar >
crocoddyl::FrameMotionTpl< Scalar >
crocoddyl::CostModelAbstractTpl::nu_
std::size_t nu_
Control dimension.
Definition:
cost-base.hpp:237
include
crocoddyl
multibody
costs
frame-velocity.hpp
Generated by
1.8.17