$search

ompl_ros_conversions.h File Reference

#include <ros/ros.h>
#include <ros/console.h>
#include <angles/angles.h>
#include <ompl/base/spaces/SO2StateSpace.h>
#include <ompl/base/spaces/SO3StateSpace.h>
#include <ompl/base/spaces/SE2StateSpace.h>
#include <ompl/base/spaces/SE3StateSpace.h>
#include <ompl/base/spaces/RealVectorStateSpace.h>
#include <ompl/geometric/PathGeometric.h>
#include <ompl/base/StateSpace.h>
#include <ompl/base/ScopedState.h>
#include <ompl/base/State.h>
#include <planning_models/kinematic_model.h>
#include <planning_models/kinematic_state.h>
#include <arm_navigation_msgs/convert_messages.h>
#include <arm_navigation_msgs/RobotState.h>
#include <arm_navigation_msgs/RobotTrajectory.h>
#include <arm_navigation_msgs/JointConstraint.h>
#include <sensor_msgs/JointState.h>
Include dependency graph for ompl_ros_conversions.h:
This graph shows which files directly or indirectly include this file:

Go to the source code of this file.

Classes

class  ompl_ros_interface::KinematicStateToOmplStateMapping
class  ompl_ros_interface::OmplStateToKinematicStateMapping
class  ompl_ros_interface::OmplStateToRobotStateMapping
class  ompl_ros_interface::RobotStateToKinematicStateMapping
class  ompl_ros_interface::RobotStateToOmplStateMapping

Namespaces

namespace  ompl_ros_interface

Enumerations

enum  ompl_ros_interface::MAPPING_TYPE {
  ompl_ros_interface::REAL_VECTOR, ompl_ros_interface::SO2, ompl_ros_interface::SO3, ompl_ros_interface::SE2,
  ompl_ros_interface::SE3, ompl_ros_interface::COMPOUND, ompl_ros_interface::UNKNOWN
}
 

enumeration of different mapping types for ompl

More...

Functions

bool ompl_ros_interface::addToOmplStateSpace (const planning_models::KinematicModel *kinematic_model, const std::string &joint_name, ompl::base::StateSpacePtr &ompl_state_space)
 Add a state to the ompl state space.
bool ompl_ros_interface::constraintsToOmplState (const arm_navigation_msgs::Constraints &constraints, ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_scoped_state, const bool &fail_if_match_not_found=true)
 Convert a set of constraints to an ompl scoped state.
bool ompl_ros_interface::getJointStateGroupToOmplStateMapping (planning_models::KinematicState::JointStateGroup *joint_state_group, const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, ompl_ros_interface::KinematicStateToOmplStateMapping &mapping)
 Create a mapping from the kinematic state to an ompl state.
bool ompl_ros_interface::getJointStateToOmplStateMapping (const sensor_msgs::JointState &joint_state, const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, ompl_ros_interface::RobotStateToOmplStateMapping &mapping, const bool &fail_if_match_not_found=true)
 Create a mapping from the ROS message joint_state to an ompl state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
ompl_ros_interface::MAPPING_TYPE ompl_ros_interface::getMappingType (const ompl::base::StateSpacePtr &state_space)
ompl_ros_interface::MAPPING_TYPE ompl_ros_interface::getMappingType (const ompl::base::StateSpace *state_space)
ompl_ros_interface::MAPPING_TYPE ompl_ros_interface::getMappingType (const planning_models::KinematicModel::JointModel *joint_model)
bool ompl_ros_interface::getOmplStateToJointStateGroupMapping (const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, planning_models::KinematicState::JointStateGroup *joint_state_group, ompl_ros_interface::OmplStateToKinematicStateMapping &mapping)
 Create a mapping from the ompl state to a kinematic state.
bool ompl_ros_interface::getOmplStateToJointStateMapping (const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, const sensor_msgs::JointState &joint_state, ompl_ros_interface::OmplStateToRobotStateMapping &mapping, const bool &fail_if_match_not_found=true)
 Create a mapping from an ompl state to the ROS message robot_state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::getOmplStateToJointTrajectoryMapping (const ompl::base::StateSpacePtr &state_space, const trajectory_msgs::JointTrajectory &joint_trajectory, ompl_ros_interface::OmplStateToRobotStateMapping &mapping)
 Get the mapping from an ompl state space to a JointTrajectory message.
bool ompl_ros_interface::getOmplStateToRobotStateMapping (const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, const arm_navigation_msgs::RobotState &robot_state, ompl_ros_interface::OmplStateToRobotStateMapping &mapping, const bool &fail_if_match_not_found=true)
 Create a mapping from an ompl state to the ROS message robot_state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::getOmplStateToRobotTrajectoryMapping (const ompl::base::StateSpacePtr &state_space, const arm_navigation_msgs::RobotTrajectory &robot_trajectory, ompl_ros_interface::OmplStateToRobotStateMapping &mapping)
 Get the mapping from an ompl state space to a RobotTrajectory message.
bool ompl_ros_interface::getRobotStateToJointModelGroupMapping (const arm_navigation_msgs::RobotState &robot_state, const planning_models::KinematicModel::JointModelGroup *joint_model_group, ompl_ros_interface::RobotStateToKinematicStateMapping &mapping)
 Get the mapping from a RobotState message to a JointModelGroup.
bool ompl_ros_interface::getRobotStateToOmplStateMapping (const arm_navigation_msgs::RobotState &robot_state, const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, ompl_ros_interface::RobotStateToOmplStateMapping &mapping, const bool &fail_if_match_not_found=true)
 Create a mapping from the ROS message robot_state to an ompl state. This function is intended to help in efficient conversion between ROS messages and an ompl state object by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::jointConstraintsToOmplState (const std::vector< arm_navigation_msgs::JointConstraint > &joint_constraints, ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_scoped_state)
 Convert a set of joint constraints to an ompl scoped state.
ompl::base::StateSpacePtr ompl_ros_interface::jointGroupToOmplStateSpacePtr (const planning_models::KinematicModel::JointModelGroup *joint_group, ompl_ros_interface::OmplStateToKinematicStateMapping &ompl_kinematic_mapping, ompl_ros_interface::KinematicStateToOmplStateMapping &kinematic_ompl_mapping)
 create a object of type ompl::base::CompoundStateSpace from an object of type planning_models::KinematicModel::JointGroup
bool ompl_ros_interface::jointStateGroupToRobotTrajectory (planning_models::KinematicState::JointStateGroup *joint_state_group, arm_navigation_msgs::RobotTrajectory &robot_trajectory)
 Create a RobotTrajectory message from a joint state group.
bool ompl_ros_interface::jointStateToRealVectorState (const sensor_msgs::JointState &joint_state, const ompl_ros_interface::RobotStateToOmplStateMapping &mapping, ompl::base::RealVectorStateSpace::StateType &real_vector_state, const bool &fail_if_match_not_found=true)
 Convert a ROS message joint state to an ompl real vector state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::kinematicStateGroupToOmplState (const planning_models::KinematicState::JointStateGroup *joint_state_group, const ompl_ros_interface::KinematicStateToOmplStateMapping &mapping, ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state)
 Convert a kinematic state to an ompl scoped state given the appropriate mapping.
bool ompl_ros_interface::omplPathGeometricToRobotTrajectory (const ompl::geometric::PathGeometric &path, const ompl_ros_interface::OmplStateToRobotStateMapping &mapping, arm_navigation_msgs::RobotTrajectory &robot_trajectory)
 Convert an ompl path to a RobotTrajectory message.
bool ompl_ros_interface::omplPathGeometricToRobotTrajectory (const ompl::geometric::PathGeometric &path, const ompl::base::StateSpacePtr &state_space, arm_navigation_msgs::RobotTrajectory &robot_trajectory)
 Convert an ompl path to a RobotTrajectory message.
bool ompl_ros_interface::omplRealVectorStateToJointState (const ompl::base::RealVectorStateSpace::StateType &ompl_state, const ompl_ros_interface::OmplStateToRobotStateMapping &mapping, sensor_msgs::JointState &joint_state)
 Convert an ompl state to the ROS message joint_state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::omplStateToKinematicStateGroup (const ompl::base::State *ompl_state, const ompl_ros_interface::OmplStateToKinematicStateMapping &mapping, planning_models::KinematicState::JointStateGroup *joint_state_group)
 Convert an ompl state to a kinematic state given the appropriate mapping.
bool ompl_ros_interface::omplStateToKinematicStateGroup (const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, const ompl_ros_interface::OmplStateToKinematicStateMapping &mapping, planning_models::KinematicState::JointStateGroup *joint_state_group)
 Convert an ompl scoped state to a kinematic state given the appropriate mapping.
bool ompl_ros_interface::omplStateToRobotState (const ompl::base::State &ompl_state, const ompl_ros_interface::OmplStateToRobotStateMapping &mapping, arm_navigation_msgs::RobotState &robot_state)
 Convert an ompl state to the ROS message robot_state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::omplStateToRobotState (const ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, const ompl_ros_interface::OmplStateToRobotStateMapping &mapping, arm_navigation_msgs::RobotState &robot_state)
 Convert an ompl state to the ROS message robot_state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
void ompl_ros_interface::poseMsgToSE3StateSpace (const geometry_msgs::Pose &pose_msg, ompl::base::SE3StateSpace::StateType &pose)
 Convert a pose message to a SE3StateSpace::StateType.
void ompl_ros_interface::quaternionMsgToSO3StateSpace (const geometry_msgs::Quaternion &quaternion_msg, ompl::base::SO3StateSpace::StateType &quaternion)
 Convert a quaternion message to a SO3StateSpace::StateType.
bool ompl_ros_interface::robotStateToJointStateGroup (const arm_navigation_msgs::RobotState &robot_state, const ompl_ros_interface::RobotStateToKinematicStateMapping &robot_state_to_joint_state_group_mapping, planning_models::KinematicState::JointStateGroup *joint_state_group)
 Convert from a RobotState to a JointStateGroup.
bool ompl_ros_interface::robotStateToOmplState (const arm_navigation_msgs::RobotState &robot_state, ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_scoped_state, const bool &fail_if_match_not_found=true)
 Convert a ROS message robot state to an ompl state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::robotStateToOmplState (const arm_navigation_msgs::RobotState &robot_state, const ompl_ros_interface::RobotStateToOmplStateMapping &mapping, ompl::base::State *ompl_state, const bool &fail_if_match_not_found=true)
 Convert a ROS message robot state to an ompl state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
bool ompl_ros_interface::robotStateToOmplState (const arm_navigation_msgs::RobotState &robot_state, const ompl_ros_interface::RobotStateToOmplStateMapping &mapping, ompl::base::ScopedState< ompl::base::CompoundStateSpace > &ompl_state, const bool &fail_if_match_not_found=true)
 Convert a ROS message robot state to an ompl state. This function is intended to help in efficient conversion between ROS messages and OMPL state objects by providing a mapping that can be cached and used frequently.
void ompl_ros_interface::SE2StateSpaceToPoseMsg (const ompl::base::SE2StateSpace::StateType &pose, geometry_msgs::Pose &pose_msg)
 Convert a SE2StateSpace::StateType to a pose message.
void ompl_ros_interface::SE3StateSpaceToPoseMsg (const ompl::base::SE3StateSpace::StateType &pose, geometry_msgs::Pose &pose_msg)
 Convert a SE3StateSpace::StateType to a pose message.
void ompl_ros_interface::SO3StateSpaceToPoseMsg (const ompl::base::SO3StateSpace::StateType &quaternion, geometry_msgs::Pose &pose_msg)
 Convert a SO3StateSpace::StateType to a pose message.
void ompl_ros_interface::SO3StateSpaceToQuaternionMsg (const ompl::base::SO3StateSpace::StateType &quaternion, geometry_msgs::Quaternion &quaternion_msg)
 Convert a SO3StateSpace::StateType to a quaternion message.
 All Classes Namespaces Files Functions Variables Typedefs Enumerations Enumerator Properties Friends


ompl_ros_interface
Author(s): Sachin Chitta
autogenerated on Fri Mar 1 14:20:34 2013