#include <mc_solver/CoMIncPlaneConstr.h>
Public Member Functions | |
CoMIncPlaneConstr (const mc_rbdyn::Robots &robots, unsigned int robotIndex, double dt) | |
void | addToSolverImpl (QPSolver &solver) override |
void | removeFromSolverImpl (QPSolver &solver) override |
void | setActiveJoints (const std::vector< std::string > &joints) |
void | setInactiveJoints (const std::vector< std::string > &joints) |
void | resetActiveJoints () |
MC_RTC_DEPRECATED void | set_planes (QPSolver &solver, const std::vector< mc_rbdyn::Plane > &planes, const std::vector< Eigen::Vector3d > &speeds={}, const std::vector< Eigen::Vector3d > &normalsDots={}, double iDist=0.05, double sDist=0.01, double damping=0.1, double dampingOff=0.) |
void | setPlanes (QPSolver &solver, const std::vector< mc_rbdyn::Plane > &planes, const std::vector< Eigen::Vector3d > &speeds={}, const std::vector< Eigen::Vector3d > &normalsDots={}, double iDist=0.05, double sDist=0.01, double damping=0.1, double dampingOff=0.) |
Public Member Functions inherited from mc_solver::ConstraintSet | |
ConstraintSet () | |
void | addToSolver (mc_solver::QPSolver &solver) |
virtual void | update (QPSolver &) |
Update the constraint. More... | |
void | removeFromSolver (mc_solver::QPSolver &solver) |
virtual | ~ConstraintSet () |
bool | inSolver () const noexcept |
QPSolver::Backend | backend () const noexcept |
Additional Inherited Members | |
Protected Attributes inherited from mc_solver::ConstraintSet | |
QPSolver::Backend | backend_ |
bool | inSolver_ = false |
For every plane provided to this constraint, this ensures that the robot's CoM remains on the positive side of this plane.
mc_solver::CoMIncPlaneConstr::CoMIncPlaneConstr | ( | const mc_rbdyn::Robots & | robots, |
unsigned int | robotIndex, | ||
double | dt | ||
) |
|
overridevirtual |
Should take care of the actual insertion into a concrete solver
Implements mc_solver::ConstraintSet.
|
overridevirtual |
Should take care of the actual removal from a concrete solver
Implements mc_solver::ConstraintSet.
void mc_solver::CoMIncPlaneConstr::resetActiveJoints | ( | ) |
Enable all joints for the constraint
|
inline |
void mc_solver::CoMIncPlaneConstr::setActiveJoints | ( | const std::vector< std::string > & | joints | ) |
Set joints that participate in the constraint
void mc_solver::CoMIncPlaneConstr::setInactiveJoints | ( | const std::vector< std::string > & | joints | ) |
Set joints that do not participate in the constraint
void mc_solver::CoMIncPlaneConstr::setPlanes | ( | QPSolver & | solver, |
const std::vector< mc_rbdyn::Plane > & | planes, | ||
const std::vector< Eigen::Vector3d > & | speeds = {} , |
||
const std::vector< Eigen::Vector3d > & | normalsDots = {} , |
||
double | iDist = 0.05 , |
||
double | sDist = 0.01 , |
||
double | damping = 0.1 , |
||
double | dampingOff = 0. |
||
) |