hpp-rbprm
4.10.1
Implementation of RB-PRM planner using hpp.
|
Go to the documentation of this file. 1 #ifndef HPP_RBPRM_KINEMATICS_CONSTRAINTS_HH
2 #define HPP_RBPRM_KINEMATICS_CONSTRAINTS_HH
6 #include <hpp/pinocchio/configuration.hh>
15 namespace reachability {
23 std::pair<MatrixX3, MatrixX3>
loadConstraintsFromObj(
const std::string& fileName,
double minDistance = 0.);
26 const pinocchio::ConfigurationPtr_t& configuration);
32 const State& state,
const std::string& limbName);
35 const hpp::pinocchio::Transform3f&
transform);
40 const fcl::Vec3f& point);
48 #endif // KINEMATICS_CONSTRAINTS_HH
HPP_PREDEF_CLASS(RbPrmFullBody)
std::pair< MatrixX3, VectorX > computeAllKinematicsConstraints(const RbPrmFullBodyPtr_t &fullBody, const pinocchio::ConfigurationPtr_t &configuration)
std::pair< MatrixX3, VectorX > getInequalitiesAtTransform(const std::pair< MatrixX3, MatrixX3 > &NV, const hpp::pinocchio::Transform3f &transform)
Definition: algorithm.hh:27
Definition: rbprm-fullbody.hh:50
bool verifyKinematicConstraints(const std::pair< MatrixX3, VectorX > &Ab, const fcl::Vec3f &point)
std::pair< MatrixX3, MatrixX3 > loadConstraintsFromObj(const std::string &fileName, double minDistance=0.)
loadConstraintsFromObj load the obj file and compute a list of normal and vertex position from it
Definition: rbprm-state.hh:40
boost::shared_ptr< RbPrmFullBody > RbPrmFullBodyPtr_t
Definition: kinematics_constraints.hh:12
fcl::Vec3f transform(const fcl::Vec3f &p, const fcl::Vec3f &tr, const fcl::Matrix3f &ro)
std::pair< MatrixX3, VectorX > computeKinematicsConstraintsForLimb(const RbPrmFullBodyPtr_t &fullBody, const State &state, const std::string &limbName)
std::pair< MatrixX3, VectorX > computeKinematicsConstraintsForState(const RbPrmFullBodyPtr_t &fullBody, const State &state)