Define a joint-acceleration residual. More...
#include <joint-acceleration.hpp>
Public Types | |
typedef ActuationModelAbstractTpl< Scalar > | ActuationModelAbstract |
typedef ResidualModelAbstractTpl< Scalar > | Base |
typedef ResidualDataJointAccelerationTpl< Scalar > | Data |
typedef DataCollectorAbstractTpl< Scalar > | DataCollectorAbstract |
typedef MathBaseTpl< Scalar > | MathBase |
typedef MathBase::MatrixXs | MatrixXs |
typedef ResidualDataAbstractTpl< Scalar > | ResidualDataAbstract |
typedef StateAbstractTpl< Scalar > | StateAbstract |
typedef MathBase::VectorXs | VectorXs |
Public Types inherited from ResidualModelAbstractTpl< _Scalar > | |
typedef ActivationDataAbstractTpl< Scalar > | ActivationDataAbstract |
typedef CostDataAbstractTpl< Scalar > | CostDataAbstract |
typedef DataCollectorAbstractTpl< Scalar > | DataCollectorAbstract |
typedef MathBase::DiagonalMatrixXs | DiagonalMatrixXs |
typedef MathBaseTpl< Scalar > | MathBase |
typedef MathBase::MatrixXs | MatrixXs |
typedef ResidualDataAbstractTpl< Scalar > | ResidualDataAbstract |
typedef StateAbstractTpl< Scalar > | StateAbstract |
typedef MathBase::VectorXs | VectorXs |
Public Member Functions | |
ResidualModelJointAccelerationTpl (boost::shared_ptr< StateAbstract > state) | |
Initialize the joint-acceleration residual model. More... | |
ResidualModelJointAccelerationTpl (boost::shared_ptr< StateAbstract > state, const std::size_t nu) | |
Initialize the joint-acceleration residual model. More... | |
ResidualModelJointAccelerationTpl (boost::shared_ptr< StateAbstract > state, const VectorXs &aref) | |
Initialize the joint-acceleration residual model. More... | |
ResidualModelJointAccelerationTpl (boost::shared_ptr< StateAbstract > state, const VectorXs &aref, const std::size_t nu) | |
Initialize the joint-acceleration residual model. More... | |
virtual void | calc (const boost::shared_ptr< ResidualDataAbstract > &data, const Eigen::Ref< const VectorXs > &x) |
virtual void | calc (const boost::shared_ptr< ResidualDataAbstract > &data, const Eigen::Ref< const VectorXs > &x, const Eigen::Ref< const VectorXs > &u) |
Compute the joint-acceleration residual. More... | |
virtual void | calcDiff (const boost::shared_ptr< ResidualDataAbstract > &data, const Eigen::Ref< const VectorXs > &x, const Eigen::Ref< const VectorXs > &u) |
Compute the derivatives of the joint-acceleration residual. More... | |
virtual boost::shared_ptr< ResidualDataAbstract > | createData (DataCollectorAbstract *const data) |
Create the joint-acceleration residual data. | |
const VectorXs & | get_reference () const |
Return the reference joint-acceleration vector. | |
virtual void | print (std::ostream &os) const |
Print relevant information of the joint-acceleration residual. More... | |
void | set_reference (const VectorXs &reference) |
Modify the reference joint-acceleration vector. | |
Public Member Functions inherited from ResidualModelAbstractTpl< _Scalar > | |
ResidualModelAbstractTpl (boost::shared_ptr< StateAbstract > state, const std::size_t nr, const bool q_dependent=true, const bool v_dependent=true, const bool u_dependent=true) | |
Initialize the residual model. More... | |
ResidualModelAbstractTpl (boost::shared_ptr< StateAbstract > state, const std::size_t nr, const std::size_t nu, const bool q_dependent=true, const bool v_dependent=true, const bool u_dependent=true) | |
Initialize the residual model. More... | |
virtual void | calcCostDiff (const boost::shared_ptr< CostDataAbstract > &cdata, const boost::shared_ptr< ResidualDataAbstract > &rdata, const boost::shared_ptr< ActivationDataAbstract > &adata, const bool update_u=true) |
Compute the derivative of the cost function. More... | |
virtual void | calcDiff (const boost::shared_ptr< ResidualDataAbstract > &data, const Eigen::Ref< const VectorXs > &x) |
Compute the Jacobian of the residual functions with respect to the state only. More... | |
std::size_t | get_nr () const |
Return the dimension of the residual vector. | |
std::size_t | get_nu () const |
Return the dimension of the control input. | |
bool | get_q_dependent () const |
Return true if the residual function depends on q. | |
const boost::shared_ptr< StateAbstract > & | get_state () const |
Return the state. | |
bool | get_u_dependent () const |
Return true if the residual function depends on u. | |
bool | get_v_dependent () const |
Return true if the residual function depends on v. | |
Public Attributes | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar | Scalar |
Public Attributes inherited from ResidualModelAbstractTpl< _Scalar > | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar | Scalar |
Protected Attributes | |
std::size_t | nr_ |
Residual vector dimension. | |
std::size_t | nu_ |
Control dimension. | |
boost::shared_ptr< StateAbstract > | state_ |
State description. | |
Protected Attributes inherited from ResidualModelAbstractTpl< _Scalar > | |
std::size_t | nr_ |
Residual vector dimension. | |
std::size_t | nu_ |
Control dimension. | |
bool | q_dependent_ |
boost::shared_ptr< StateAbstract > | state_ |
State description. | |
bool | u_dependent_ |
VectorXs | unone_ |
No control vector. | |
bool | v_dependent_ |
Define a joint-acceleration residual.
This residual function is defined as \(\mathbf{r}=\mathbf{u}-\mathbf{u}^*\), where \(\mathbf{u},\mathbf{u}^*\in~\mathbb{R}^{nu}\) are the current and reference joint acceleration, respectively. Note that the dimension of the residual vector is obtained from StateAbstract::nv
, as it represents the generalized acceleration.
Both residual and residual Jacobians are computed analytically.
As described in ResidualModelAbstractTpl(), the residual value and its Jacobians are calculated by calc
and calcDiff
, respectively.
ResidualModelAbstractTpl
, calc()
, calcDiff()
, createData()
Definition at line 37 of file joint-acceleration.hpp.
ResidualModelJointAccelerationTpl | ( | boost::shared_ptr< StateAbstract > | state, |
const VectorXs & | aref, | ||
const std::size_t | nu | ||
) |
Initialize the joint-acceleration residual model.
[in] | state | State description |
[in] | aref | Reference joint acceleration |
[in] | nu | Dimension of the control vector |
ResidualModelJointAccelerationTpl | ( | boost::shared_ptr< StateAbstract > | state, |
const VectorXs & | aref | ||
) |
Initialize the joint-acceleration residual model.
The default nu
value is obtained from StateAbstractTpl::get_nv()
.
[in] | state | State description |
[in] | aref | Reference joint acceleration |
ResidualModelJointAccelerationTpl | ( | boost::shared_ptr< StateAbstract > | state, |
const std::size_t | nu | ||
) |
Initialize the joint-acceleration residual model.
The default reference joint acceleration is obtained from MathBaseTpl<>::VectorXs::Zero(state->get_nv())
.
[in] | state | State description |
[in] | nu | Dimension of the control vector |
ResidualModelJointAccelerationTpl | ( | boost::shared_ptr< StateAbstract > | state | ) |
Initialize the joint-acceleration residual model.
The default reference joint acceleration is obtained from MathBaseTpl<>::VectorXs::Zero(state->get_nv())
. The default nu
value is obtained from StateAbstractTpl::get_nv()
.
[in] | state | State description |
|
virtual |
Compute the joint-acceleration residual.
[in] | data | Joint-acceleration residual data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
[in] | u | Control input \(\mathbf{u}\in\mathbb{R}^{nu}\) |
Reimplemented from ResidualModelAbstractTpl< _Scalar >.
|
virtual |
It updates the residual vector based on the state only. This function is used in the terminal nodes of an optimal control problem.
[in] | data | Residual data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
Reimplemented from ResidualModelAbstractTpl< _Scalar >.
|
virtual |
Compute the derivatives of the joint-acceleration residual.
[in] | data | Joint-acceleration residual data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
[in] | u | Control input \(\mathbf{u}\in\mathbb{R}^{nu}\) |
Reimplemented from ResidualModelAbstractTpl< _Scalar >.
|
virtual |
Print relevant information of the joint-acceleration residual.
[out] | os | Output stream object |
Reimplemented from ResidualModelAbstractTpl< _Scalar >.