![]() |
Tesseract 0.28.4
|
Tesseract Environment Utility Functions. More...
#include <tesseract/collision/utils.h>#include <tesseract/common/logging.h>#include <iostream>#include <tesseract/environment/utils.h>#include <tesseract/scene_graph/graph.h>#include <tesseract/scene_graph/joint.h>#include <tesseract/state_solver/state_solver.h>#include <tesseract/kinematics/joint_group.h>#include <tesseract/collision/discrete_contact_manager.h>#include <tesseract/collision/continuous_contact_manager.h>Typedefs | |
| using | tesseract::environment::CalcStateFn = std::function<tesseract::common::LinkIdTransformMap(const Eigen::VectorXd& state)> |
Functions | |
| void | tesseract::environment::getActiveLinkIdsRecursive (std::vector< tesseract::common::LinkId > &active_links, const tesseract::scene_graph::SceneGraph &scene_graph, const tesseract::common::LinkId ¤t_link, bool active) |
| Get the active link ids Recursively. | |
| void | tesseract::environment::checkTrajectorySegment (tesseract::collision::ContactResultMap &contact_results, tesseract::collision::ContinuousContactManager &manager, const tesseract::common::LinkIdTransformMap &state0, const tesseract::common::LinkIdTransformMap &state1, const tesseract::collision::ContactRequest &contact_request) |
| Should perform a continuous collision check between two states only passing along the contact_request to the manager. | |
| void | tesseract::environment::checkTrajectoryState (tesseract::collision::ContactResultMap &contact_results, tesseract::collision::DiscreteContactManager &manager, const tesseract::common::LinkIdTransformMap &state, const tesseract::collision::ContactRequest &contact_request) |
| Should perform a discrete collision check a state only passing contact_request to the manager. | |
| void | tesseract::environment::checkTrajectoryState (tesseract::collision::ContactResultMap &contact_results, tesseract::collision::ContinuousContactManager &manager, const tesseract::common::LinkIdTransformMap &state, const tesseract::collision::ContactRequest &contact_request) |
| Should perform a discrete collision check a state first configuring manager with config. | |
| void | tesseract::environment::printContinuousDebugInfo (const std::vector< std::string > &joint_names, const Eigen::VectorXd &swp0, const Eigen::VectorXd &swp1, tesseract::common::TrajArray::Index step_idx, tesseract::common::TrajArray::Index step_size, tesseract::common::TrajArray::Index sub_step_idx=-1) |
| void | tesseract::environment::printDiscreteDebugInfo (const std::vector< std::string > &joint_names, const Eigen::VectorXd &swp, tesseract::common::TrajArray::Index step_idx, tesseract::common::TrajArray::Index step_size, tesseract::common::TrajArray::Index sub_step_idx=-1) |
| tesseract::collision::ContactTrajectoryResults | tesseract::environment::checkTrajectory (std::vector< tesseract::collision::ContactResultMap > &contacts, tesseract::collision::ContinuousContactManager &manager, const CalcStateFn &state_fn, const std::vector< tesseract::common::JointId > &joint_ids, const tesseract::common::TrajArray &traj, const tesseract::collision::CollisionCheckConfig &config) |
| tesseract::collision::ContactTrajectoryResults | tesseract::environment::checkTrajectory (std::vector< tesseract::collision::ContactResultMap > &contacts, tesseract::collision::ContinuousContactManager &manager, const tesseract::scene_graph::StateSolver &state_solver, const std::vector< tesseract::common::JointId > &joint_ids, const tesseract::common::TrajArray &traj, const tesseract::collision::CollisionCheckConfig &config) |
| Should perform a continuous collision check over the trajectory and stop on first collision. | |
| tesseract::collision::ContactTrajectoryResults | tesseract::environment::checkTrajectory (std::vector< tesseract::collision::ContactResultMap > &contacts, tesseract::collision::ContinuousContactManager &manager, const tesseract::kinematics::JointGroup &manip, const tesseract::common::TrajArray &traj, const tesseract::collision::CollisionCheckConfig &config) |
| Should perform a continuous collision check over the trajectory and stop on first collision. | |
| tesseract::collision::ContactTrajectoryResults | tesseract::environment::checkTrajectory (std::vector< tesseract::collision::ContactResultMap > &contacts, tesseract::collision::DiscreteContactManager &manager, const CalcStateFn &state_fn, const std::vector< tesseract::common::JointId > &joint_ids, const tesseract::common::TrajArray &traj, const tesseract::collision::CollisionCheckConfig &config) |
| tesseract::collision::ContactTrajectoryResults | tesseract::environment::checkTrajectory (std::vector< tesseract::collision::ContactResultMap > &contacts, tesseract::collision::DiscreteContactManager &manager, const tesseract::scene_graph::StateSolver &state_solver, const std::vector< tesseract::common::JointId > &joint_ids, const tesseract::common::TrajArray &traj, const tesseract::collision::CollisionCheckConfig &config) |
| Should perform a discrete collision check over the trajectory and stop on first collision. | |
| tesseract::collision::ContactTrajectoryResults | tesseract::environment::checkTrajectory (std::vector< tesseract::collision::ContactResultMap > &contacts, tesseract::collision::DiscreteContactManager &manager, const tesseract::kinematics::JointGroup &manip, const tesseract::common::TrajArray &traj, const tesseract::collision::CollisionCheckConfig &config) |
| Should perform a discrete collision check over the trajectory and stop on first collision. | |
Tesseract Environment Utility Functions.
| void tesseract::environment::getActiveLinkIdsRecursive | ( | std::vector< tesseract::common::LinkId > & | active_links, |
| const tesseract::scene_graph::SceneGraph & | scene_graph, | ||
| const tesseract::common::LinkId & | current_link, | ||
| bool | active ) |
Get the active link ids Recursively.
Get the active Link Names Recursively.
This currently only works for graphs that are trees. Need to create a generic method using boost::visitor TODO: Need to update using graph->getLinkChildren
| active_links | |
| scene_graph | |
| current_link | |
| active |
| void tesseract::environment::checkTrajectorySegment | ( | tesseract::collision::ContactResultMap & | contact_results, |
| tesseract::collision::ContinuousContactManager & | manager, | ||
| const tesseract::common::LinkIdTransformMap & | state0, | ||
| const tesseract::common::LinkIdTransformMap & | state1, | ||
| const tesseract::collision::ContactRequest & | contact_request ) |
Should perform a continuous collision check between two states only passing along the contact_request to the manager.
| contact_results | The contact results to populate. It does not get cleared |
| manager | A continuous contact manager |
| state0 | First environment state |
| state1 | Second environment state |
| contact_request | Contact request passed to the manager |
| void tesseract::environment::checkTrajectoryState | ( | tesseract::collision::ContactResultMap & | contact_results, |
| tesseract::collision::DiscreteContactManager & | manager, | ||
| const tesseract::common::LinkIdTransformMap & | state, | ||
| const tesseract::collision::ContactRequest & | contact_request ) |
Should perform a discrete collision check a state only passing contact_request to the manager.
| contact_results | The contact results to populate. It does not get cleared |
| manager | A discrete contact manager |
| state | Environment state |
| contact_request | Contact request passed to the manager |
| void tesseract::environment::checkTrajectoryState | ( | tesseract::collision::ContactResultMap & | contact_results, |
| tesseract::collision::ContinuousContactManager & | manager, | ||
| const tesseract::common::LinkIdTransformMap & | state, | ||
| const tesseract::collision::ContactRequest & | contact_request ) |
Should perform a discrete collision check a state first configuring manager with config.
| contact_results | The contact results to populate. It does not get cleared |
| manager | A continuous contact manager |
| state | Environment state |
| contact_request | Contact request passed to the manager |
| tesseract::collision::ContactTrajectoryResults tesseract::environment::checkTrajectory | ( | std::vector< tesseract::collision::ContactResultMap > & | contacts, |
| tesseract::collision::ContinuousContactManager & | manager, | ||
| const CalcStateFn & | state_fn, | ||
| const std::vector< tesseract::common::JointId > & | joint_ids, | ||
| const tesseract::common::TrajArray & | traj, | ||
| const tesseract::collision::CollisionCheckConfig & | config ) |
Making this thread_local does not help because it is not called enough during planning
| tesseract::collision::ContactTrajectoryResults tesseract::environment::checkTrajectory | ( | std::vector< tesseract::collision::ContactResultMap > & | contacts, |
| tesseract::collision::ContinuousContactManager & | manager, | ||
| const tesseract::scene_graph::StateSolver & | state_solver, | ||
| const std::vector< tesseract::common::JointId > & | joint_ids, | ||
| const tesseract::common::TrajArray & | traj, | ||
| const tesseract::collision::CollisionCheckConfig & | config ) |
Should perform a continuous collision check over the trajectory and stop on first collision.
| contacts | A vector of ContactMap where each index corresponds to a segment in the trajectory. |
| manager | A continuous contact manager |
| state_solver | The environment state solver |
| joint_ids | JointIds corresponding to the values in traj (must be in same order) |
| traj | The joint values at each time step |
| config | CollisionCheckConfig used to specify collision check settings |
| tesseract::collision::ContactTrajectoryResults tesseract::environment::checkTrajectory | ( | std::vector< tesseract::collision::ContactResultMap > & | contacts, |
| tesseract::collision::ContinuousContactManager & | manager, | ||
| const tesseract::kinematics::JointGroup & | manip, | ||
| const tesseract::common::TrajArray & | traj, | ||
| const tesseract::collision::CollisionCheckConfig & | config ) |
Should perform a continuous collision check over the trajectory and stop on first collision.
| contacts | A vector of ContactMap where each index corresponds to a segment in the trajectory. The length should be trajectory size minus one. |
| manager | A continuous contact manager |
| manip | The kinematic joint group |
| traj | The joint values at each time step |
| config | CollisionCheckConfig used to specify collision check settings |
| tesseract::collision::ContactTrajectoryResults tesseract::environment::checkTrajectory | ( | std::vector< tesseract::collision::ContactResultMap > & | contacts, |
| tesseract::collision::DiscreteContactManager & | manager, | ||
| const CalcStateFn & | state_fn, | ||
| const std::vector< tesseract::common::JointId > & | joint_ids, | ||
| const tesseract::common::TrajArray & | traj, | ||
| const tesseract::collision::CollisionCheckConfig & | config ) |
Making this thread_local does not help because it is not called enough during planning
| tesseract::collision::ContactTrajectoryResults tesseract::environment::checkTrajectory | ( | std::vector< tesseract::collision::ContactResultMap > & | contacts, |
| tesseract::collision::DiscreteContactManager & | manager, | ||
| const tesseract::scene_graph::StateSolver & | state_solver, | ||
| const std::vector< tesseract::common::JointId > & | joint_ids, | ||
| const tesseract::common::TrajArray & | traj, | ||
| const tesseract::collision::CollisionCheckConfig & | config ) |
Should perform a discrete collision check over the trajectory and stop on first collision.
| contacts | A vector of ContactMap where each index corresponds to a segment in the trajectory. |
| manager | A discrete contact manager |
| state_solver | The environment state solver |
| joint_ids | JointIds corresponding to the values in traj (must be in same order) |
| traj | The joint values at each time step |
| config | CollisionCheckConfig used to specify collision check settings |
| tesseract::collision::ContactTrajectoryResults tesseract::environment::checkTrajectory | ( | std::vector< tesseract::collision::ContactResultMap > & | contacts, |
| tesseract::collision::DiscreteContactManager & | manager, | ||
| const tesseract::kinematics::JointGroup & | manip, | ||
| const tesseract::common::TrajArray & | traj, | ||
| const tesseract::collision::CollisionCheckConfig & | config ) |
Should perform a discrete collision check over the trajectory and stop on first collision.
| contacts | A vector of ContactMap where each index corresponds to a segment in the trajectory, except the last which is the end state. The length should be the same size as the input trajectory. |
| manager | A continuous contact manager |
| manip | The kinematic joint group |
| traj | The joint values at each time step |
| config | CollisionCheckConfig used to specify collision check settings |