Public Types | |
typedef ActionDataAbstractTpl< Scalar > | ActionDataAbstract |
typedef ActionModelAbstractTpl< Scalar > | Base |
typedef ActionDataUnicycleTpl< Scalar > | Data |
typedef MathBaseTpl< Scalar > | MathBase |
typedef MathBase::Vector2s | Vector2s |
typedef MathBase::VectorXs | VectorXs |
![]() | |
typedef ActionDataAbstractTpl< Scalar > | ActionDataAbstract |
typedef MathBaseTpl< Scalar > | MathBase |
typedef ScalarSelector< Scalar >::type | ScalarType |
typedef StateAbstractTpl< Scalar > | StateAbstract |
typedef MathBase::VectorXs | VectorXs |
Public Member Functions | |
virtual void | calc (const std::shared_ptr< ActionDataAbstract > &data, const Eigen::Ref< const VectorXs > &x) override |
Compute the total cost value for nodes that depends only on the state. | |
virtual void | calc (const std::shared_ptr< ActionDataAbstract > &data, const Eigen::Ref< const VectorXs > &x, const Eigen::Ref< const VectorXs > &u) override |
Compute the next state and cost value. | |
virtual void | calcDiff (const std::shared_ptr< ActionDataAbstract > &data, const Eigen::Ref< const VectorXs > &x) override |
Compute the derivatives of the cost functions with respect to the state only. | |
virtual void | calcDiff (const std::shared_ptr< ActionDataAbstract > &data, const Eigen::Ref< const VectorXs > &x, const Eigen::Ref< const VectorXs > &u) override |
Compute the derivatives of the dynamics and cost functions. | |
template<typename NewScalar > | |
ActionModelUnicycleTpl< NewScalar > | cast () const |
Cast the unicycle model to a different scalar type. | |
virtual bool | checkData (const std::shared_ptr< ActionDataAbstract > &data) override |
Checks that a specific data belongs to this model. | |
virtual std::shared_ptr< ActionDataAbstract > | createData () override |
Create the action data. | |
const Vector2s & | get_cost_weights () const |
Scalar | get_dt () const |
virtual void | print (std::ostream &os) const override |
Print relevant information of the unicycle model. | |
void | set_cost_weights (const Vector2s &weights) |
void | set_dt (const Scalar dt) |
![]() | |
ActionModelAbstractTpl (const ActionModelAbstractTpl< Scalar > &other) | |
Copy constructor. | |
ActionModelAbstractTpl (std::shared_ptr< StateAbstract > state, const std::size_t nu, const std::size_t nr=0, const std::size_t ng=0, const std::size_t nh=0, const std::size_t ng_T=0, const std::size_t nh_T=0) | |
Initialize the action model. | |
virtual const VectorXs & | get_g_lb () const |
Return the lower bound of the inequality constraints. | |
virtual const VectorXs & | get_g_ub () const |
Return the upper bound of the inequality constraints. | |
bool | get_has_control_limits () const |
Indicates if there are defined control limits. | |
virtual std::size_t | get_ng () const |
Return the number of inequality constraints. | |
virtual std::size_t | get_ng_T () const |
Return the number of inequality terminal constraints. | |
virtual std::size_t | get_nh () const |
Return the number of equality constraints. | |
virtual std::size_t | get_nh_T () const |
Return the number of equality terminal constraints. | |
std::size_t | get_nr () const |
Return the dimension of the cost-residual vector. | |
std::size_t | get_nu () const |
Return the dimension of the control input. | |
const std::shared_ptr< StateAbstract > & | get_state () const |
Return the state. | |
const VectorXs & | get_u_lb () const |
Return the control lower bound. | |
const VectorXs & | get_u_ub () const |
Return the control upper bound. | |
virtual void | quasiStatic (const std::shared_ptr< ActionDataAbstract > &data, Eigen::Ref< VectorXs > u, const Eigen::Ref< const VectorXs > &x, const std::size_t maxiter=100, const Scalar tol=Scalar(1e-9)) |
Computes the quasic static commands. | |
VectorXs | quasiStatic_x (const std::shared_ptr< ActionDataAbstract > &data, const VectorXs &x, const std::size_t maxiter=100, const Scalar tol=Scalar(1e-9)) |
void | set_g_lb (const VectorXs &g_lb) |
Modify the lower bound of the inequality constraints. | |
void | set_g_ub (const VectorXs &g_ub) |
Modify the upper bound of the inequality constraints. | |
void | set_u_lb (const VectorXs &u_lb) |
Modify the control lower bounds. | |
void | set_u_ub (const VectorXs &u_ub) |
Modify the control upper bounds. | |
Public Attributes | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar | Scalar |
![]() | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar | Scalar |
Protected Attributes | |
std::size_t | nu_ |
Control dimension. | |
std::shared_ptr< StateAbstract > | state_ |
< Control dimension | |
![]() | |
VectorXs | g_lb_ |
Lower bound of the inequality constraints. | |
VectorXs | g_ub_ |
Lower bound of the inequality constraints. | |
bool | has_control_limits_ |
std::size_t | ng_ |
Number of inequality constraints. | |
std::size_t | ng_T_ |
Number of inequality terminal constraints. | |
std::size_t | nh_ |
Number of equality constraints. | |
std::size_t | nh_T_ |
Number of equality terminal constraints. | |
std::size_t | nr_ |
Dimension of the cost residual. | |
std::size_t | nu_ |
Control dimension. | |
std::shared_ptr< StateAbstract > | state_ |
Model of the state. | |
VectorXs | u_lb_ |
Lower control limits. | |
VectorXs | u_ub_ |
Upper control limits. | |
VectorXs | unone_ |
Neutral state. | |
Additional Inherited Members | |
![]() | |
void | update_has_control_limits () |
Update the status of the control limits (i.e. if there are defined limits) | |
Definition at line 19 of file unicycle.hpp.
typedef ActionDataAbstractTpl<Scalar> ActionDataAbstract |
Definition at line 25 of file unicycle.hpp.
typedef ActionModelAbstractTpl<Scalar> Base |
Definition at line 26 of file unicycle.hpp.
typedef ActionDataUnicycleTpl<Scalar> Data |
Definition at line 27 of file unicycle.hpp.
typedef MathBaseTpl<Scalar> MathBase |
Definition at line 28 of file unicycle.hpp.
typedef MathBase::VectorXs VectorXs |
Definition at line 29 of file unicycle.hpp.
typedef MathBase::Vector2s Vector2s |
Definition at line 30 of file unicycle.hpp.
|
overridevirtual |
Compute the next state and cost value.
[in] | data | Action data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
[in] | u | Control input \(\mathbf{u}\in\mathbb{R}^{nu}\) |
Implements ActionModelAbstractTpl< _Scalar >.
|
overridevirtual |
Compute the total cost value for nodes that depends only on the state.
It updates the total cost and the next state is not computed as it is not expected to change. This function is used in the terminal nodes of an optimal control problem.
[in] | data | Action data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
Reimplemented from ActionModelAbstractTpl< _Scalar >.
|
overridevirtual |
Compute the derivatives of the dynamics and cost functions.
It computes the partial derivatives of the dynamical system and the cost function. It assumes that calc()
has been run first. This function builds a linear-quadratic approximation of the action model (i.e. dynamical system and cost function).
[in] | data | Action data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
[in] | u | Control input \(\mathbf{u}\in\mathbb{R}^{nu}\) |
Implements ActionModelAbstractTpl< _Scalar >.
|
overridevirtual |
Compute the derivatives of the cost functions with respect to the state only.
It updates the derivatives of the cost function with respect to the state only. This function is used in the terminal nodes of an optimal control problem.
[in] | data | Action data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
Reimplemented from ActionModelAbstractTpl< _Scalar >.
|
overridevirtual |
Create the action data.
Reimplemented from ActionModelAbstractTpl< _Scalar >.
ActionModelUnicycleTpl< NewScalar > cast | ( | ) | const |
Cast the unicycle model to a different scalar type.
It is useful for operations requiring different precision or scalar types.
NewScalar | The new scalar type to cast to. |
|
overridevirtual |
Checks that a specific data belongs to this model.
Reimplemented from ActionModelAbstractTpl< _Scalar >.
|
overridevirtual |
Print relevant information of the unicycle model.
[out] | os | Output stream object |
Reimplemented from ActionModelAbstractTpl< _Scalar >.
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar Scalar |
Definition at line 24 of file unicycle.hpp.
|
protected |
Control dimension.
Definition at line 328 of file action-base.hpp.
|
protected |
< Control dimension
Definition at line 334 of file action-base.hpp.