se2ez
Public Member Functions | Protected Member Functions | Private Attributes | List of all members
se2ez::plan::CircleConstraint Class Reference

#include <constraint.h>

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

Public Member Functions

 CircleConstraint (const std::string &name, const RobotPtr &robot, const std::string &frame, const std::string &base, const Eigen::Vector2d &p, const Eigen::Vector2d &r, unsigned int exponent=2)
 
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 getCircle (Eigen::Ref< Eigen::VectorXd > p, Eigen::Ref< Eigen::VectorXd > r, double &v, 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

double getAngle (const Eigen::Isometry2d &frame, const Eigen::Isometry2d &base) const
 
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_
 
const Eigen::Vector2d r_
 
const unsigned int exp_
 

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 155 of file constraint.h.

Constructor & Destructor Documentation

◆ CircleConstraint()

plan::CircleConstraint::CircleConstraint ( const std::string &  name,
const RobotPtr &  robot,
const std::string &  frame,
const std::string &  base,
const Eigen::Vector2d &  p,
const Eigen::Vector2d &  r,
unsigned int  exponent = 2 
)

CircleConstraint

Definition at line 485 of file constraint.cpp.

Member Function Documentation

◆ copy()

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

Implements ompl::base::Foliation.

Definition at line 501 of file constraint.cpp.

◆ functionInternal()

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

Implements se2ez::plan::FrameConstraint.

Definition at line 531 of file constraint.cpp.

◆ getAngle()

double plan::CircleConstraint::getAngle ( const Eigen::Isometry2d &  frame,
const Eigen::Isometry2d &  base 
) const
protected

Definition at line 494 of file constraint.cpp.

◆ getCircle()

void plan::CircleConstraint::getCircle ( Eigen::Ref< Eigen::VectorXd >  p,
Eigen::Ref< Eigen::VectorXd >  r,
double &  v,
const StatePtr &  state 
) const

Definition at line 554 of file constraint.cpp.

◆ getFrond()

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

Implements ompl::base::Foliation.

Definition at line 524 of file constraint.cpp.

◆ getLeaf()

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

Implements ompl::base::Foliation.

Definition at line 515 of file constraint.cpp.

◆ getTransversal()

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

Implements ompl::base::Foliation.

Definition at line 506 of file constraint.cpp.

◆ jacobianInternal()

void plan::CircleConstraint::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 542 of file constraint.cpp.

Member Data Documentation

◆ exp_

const unsigned int se2ez::plan::CircleConstraint::exp_
private

Definition at line 181 of file constraint.h.

◆ p_

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

Definition at line 179 of file constraint.h.

◆ r_

const Eigen::Vector2d se2ez::plan::CircleConstraint::r_
private

Definition at line 180 of file constraint.h.

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