aligator
0.9.0
A primal-dual augmented Lagrangian-type solver for nonlinear trajectory optimization.
|
This residual implements the wrench cone for a centroidal model with control \(u = (f_1,...,f_c) \) with \(f_k\) 6D spatial force. More...
#include <aligator/modelling/centroidal/centroidal-wrench-cone.hpp>
Public Types | |
using | Base = StageFunctionDataTpl<Scalar> |
Public Types inherited from aligator::StageFunctionDataTpl< Scalar > | |
using | Scalar = _Scalar |
Public Member Functions | |
CentroidalWrenchConeDataTpl (const CentroidalWrenchConeResidualTpl< Scalar > *model) | |
Public Member Functions inherited from aligator::StageFunctionDataTpl< Scalar > | |
ALIGATOR_DYNAMIC_TYPEDEFS (Scalar) | |
StageFunctionDataTpl (const int ndx, const int nu, const int nr) | |
Default constructor. | |
StageFunctionDataTpl (const StageFunctionTpl< Scalar > &model) | |
virtual | ~StageFunctionDataTpl ()=default |
Public Attributes | |
Eigen::Matrix< Scalar, 17, 6 > | Jtemp_ |
Public Attributes inherited from aligator::StageFunctionDataTpl< Scalar > | |
const int | ndx1 |
const int | nu |
const int | nr |
const int | nvar = ndx1 + nu |
Total number of variables. | |
VectorXs | value_ |
Function value. | |
VectorRef | valref_ |
MatrixXs | jac_buffer_ |
Full Jacobian. | |
MatrixXs | vhp_buffer_ |
Vector-Hessian product buffer. | |
MatrixRef | Jx_ |
Jacobian with respect to \(x\). | |
MatrixRef | Ju_ |
Jacobian with respect to \(u\). | |
MatrixRef | Hxx_ |
MatrixRef | Hxu_ |
MatrixRef | Huu_ |
This residual implements the wrench cone for a centroidal model with control \(u = (f_1,...,f_c) \) with \(f_k\) 6D spatial force.
Considering an contact k exerting 6D force f, the residual returns \( A f \) with \(A \in \mathbb{R}^{17 \times 6}\) the wrench cone matrix gathering Coulomb friction inequalities, CoP inequalities and limits on vertical torque. The usual wrench cone approximation with 4 facets is leveraged here. The frame in contact is supposed to be rectangular.
Definition at line 55 of file centroidal-wrench-cone.hpp.
using aligator::CentroidalWrenchConeDataTpl< Scalar >::Base = StageFunctionDataTpl<Scalar> |
Definition at line 57 of file centroidal-wrench-cone.hpp.
aligator::CentroidalWrenchConeDataTpl< Scalar >::CentroidalWrenchConeDataTpl | ( | const CentroidalWrenchConeResidualTpl< Scalar > * | model | ) |
Eigen::Matrix<Scalar, 17, 6> aligator::CentroidalWrenchConeDataTpl< Scalar >::Jtemp_ |
Definition at line 59 of file centroidal-wrench-cone.hpp.