se2ez
se2ez::plan::PointConstraint Class Reference

#include <constraint.h>

Inheritance diagram for se2ez::plan::PointConstraint:
[legend]

Public Member Functions

 PointConstraint (const std::string &name, const RobotPtr &robot, const std::string &frame, const std::string &base, const Eigen::Vector2d &p)
 
ompl::base::FoliationPtr copy () const override
 
Eigen::VectorXd getTransversal (const Eigen::Ref< const Eigen::VectorXd > &state) const override
 
ompl::base::ConstraintPtr getLeaf (const Eigen::Ref< const Eigen::VectorXd > &tv) const override
 
ompl::base::FoliationPtr getFrond (const Eigen::Ref< const Eigen::VectorXd > &a, const Eigen::Ref< const Eigen::VectorXd > &b) const override
 
void getPoint (Eigen::Ref< Eigen::VectorXd > a, const StatePtr &state) const
 
- Public Member Functions inherited from se2ez::plan::FrameConstraint
void function (const ompl::base::State *state, Eigen::Ref< Eigen::VectorXd > out) const override
 
void function (const Eigen::Ref< const Eigen::VectorXd > &x, Eigen::Ref< Eigen::VectorXd > out) const override
 
void jacobian (const ompl::base::State *state, Eigen::Ref< Eigen::MatrixXd > out) const override
 
void jacobian (const Eigen::Ref< const Eigen::VectorXd > &x, Eigen::Ref< Eigen::MatrixXd > out) const override
 
bool project (ompl::base::State *state) const override
 
bool project (Eigen::Ref< Eigen::VectorXd > x) const override
 
double distance (const ompl::base::State *state) const override
 
bool isSatisfied (const ompl::base::State *state) const override
 
void setDrawOffset (const Eigen::Ref< const Eigen::Vector2d > &v)
 
const Eigen::Vector2d & getDrawOffset () const
 
- Public Member Functions inherited from ompl::base::Foliation
 Foliation (const unsigned int ambientDim, const unsigned int coDim, const unsigned int leafDim, double tolerance=magic::CONSTRAINT_PROJECTION_TOLERANCE)
 
unsigned int getLeafDimension () const
 
unsigned int getTransverseDimension () const
 
void setLeafDimension (unsigned int p)
 
void setTransverseDimension (unsigned int t)
 

Protected Member Functions

void functionInternal (const Eigen::Isometry2d &pose, const Eigen::Isometry2d &base, Eigen::Ref< Eigen::VectorXd > out) const override
 
void jacobianInternal (const Eigen::Isometry2d &pose, const Eigen::Isometry2d &base, const Eigen::MatrixXd &jac, Eigen::Ref< Eigen::MatrixXd > out) const override
 
- Protected Member Functions inherited from se2ez::plan::FrameConstraint
 FrameConstraint (const std::string &name, const RobotPtr &robot, const std::string &frame, const std::string &base, unsigned int dimension=1, unsigned int leaf=0)
 
const std::pair< Eigen::Isometry2d, Eigen::Isometry2d > getPose (const ompl::base::State *state) const
 
const std::pair< Eigen::Isometry2d, Eigen::Isometry2d > getPose (const Eigen::Ref< const Eigen::VectorXd > &x) const
 

Private Attributes

const Eigen::Vector2d p_
 

Additional Inherited Members

- Protected Attributes inherited from se2ez::plan::FrameConstraint
Eigen::Vector2d draw_ {Eigen::Vector2d::Zero()}
 
const std::string name_
 
const RobotPtr robot_
 
const std::string frame_
 
const std::string base_
 
StatePtr state_
 
std::recursive_mutex mutex_
 
- Protected Attributes inherited from ompl::base::Foliation
unsigned int p_
 Leaf dimension. More...
 
unsigned int t_
 Transverse dimension. More...
 

Detailed Description

Definition at line 129 of file constraint.h.

Constructor & Destructor Documentation

◆ PointConstraint()

plan::PointConstraint::PointConstraint ( const std::string name,
const RobotPtr robot,
const std::string frame,
const std::string base,
const Eigen::Vector2d &  p 
)

PointConstraint

Definition at line 426 of file constraint.cpp.

Member Function Documentation

◆ copy()

ompl::base::FoliationPtr plan::PointConstraint::copy ( ) const
overridevirtual

Implements ompl::base::Foliation.

Definition at line 433 of file constraint.cpp.

◆ functionInternal()

void plan::PointConstraint::functionInternal ( const Eigen::Isometry2d &  pose,
const Eigen::Isometry2d &  base,
Eigen::Ref< Eigen::VectorXd >  out 
) const
overrideprotectedvirtual

Implements se2ez::plan::FrameConstraint.

Definition at line 456 of file constraint.cpp.

◆ getFrond()

ompl::base::FoliationPtr plan::PointConstraint::getFrond ( const Eigen::Ref< const Eigen::VectorXd > &  a,
const Eigen::Ref< const Eigen::VectorXd > &  b 
) const
overridevirtual

Implements ompl::base::Foliation.

Definition at line 449 of file constraint.cpp.

◆ getLeaf()

ompl::base::ConstraintPtr plan::PointConstraint::getLeaf ( const Eigen::Ref< const Eigen::VectorXd > &  tv) const
overridevirtual

Implements ompl::base::Foliation.

Definition at line 443 of file constraint.cpp.

◆ getPoint()

void plan::PointConstraint::getPoint ( Eigen::Ref< Eigen::VectorXd >  a,
const StatePtr state 
) const

Definition at line 475 of file constraint.cpp.

◆ getTransversal()

Eigen::VectorXd plan::PointConstraint::getTransversal ( const Eigen::Ref< const Eigen::VectorXd > &  state) const
overridevirtual

Implements ompl::base::Foliation.

Definition at line 438 of file constraint.cpp.

◆ jacobianInternal()

void plan::PointConstraint::jacobianInternal ( const Eigen::Isometry2d &  pose,
const Eigen::Isometry2d &  base,
const Eigen::MatrixXd &  jac,
Eigen::Ref< Eigen::MatrixXd >  out 
) const
overrideprotectedvirtual

Implements se2ez::plan::FrameConstraint.

Definition at line 465 of file constraint.cpp.

Member Data Documentation

◆ p_

const Eigen::Vector2d se2ez::plan::PointConstraint::p_
private

Definition at line 152 of file constraint.h.


The documentation for this class was generated from the following files: