#include <ompl_ros_rpy_ik_state_transformer.h>
Public Member Functions | |
virtual bool | configureOnRequest (const motion_planning_msgs::GetMotionPlan::Request &request, motion_planning_msgs::GetMotionPlan::Response &response) |
Configure the transformer when a request is received. This is typically a one time configuration for each planning request. | |
virtual bool | forwardTransform (const motion_planning_msgs::RobotState &robot_state, ompl::base::State &ompl_state) |
Compute the forward transform (from physical state to planning state). | |
virtual motion_planning_msgs::RobotState | getDefaultState () |
Get a default physical state. | |
virtual bool | initialize () |
Custom initialization can be performed here. | |
virtual bool | inverseTransform (const ompl::base::State &ompl_state, motion_planning_msgs::RobotState &robot_state) |
Compute the inverse transform (from planning state to physical state). | |
OmplRosRPYIKStateTransformer (const ompl::base::StateSpacePtr &state_space, const planning_models::KinematicModel::JointModelGroup *physical_joint_model_group) | |
~OmplRosRPYIKStateTransformer () | |
Private Member Functions | |
void | omplStateToPose (const ompl::base::State &ompl_state, geometry_msgs::Pose &pose) |
Private Attributes | |
ompl_ros_interface::OmplStateToRobotStateMapping | ompl_state_to_robot_state_mapping_ |
int | pitch_index_ |
int | real_vector_index_ |
ompl_ros_interface::RobotStateToOmplStateMapping | robot_state_to_ompl_state_mapping_ |
int | roll_index_ |
boost::shared_ptr < ompl::base::ScopedState < ompl::base::CompoundStateSpace > > | scoped_state_ |
motion_planning_msgs::RobotState | seed_state_ |
motion_planning_msgs::RobotState | solution_state_ |
int | x_index_ |
int | y_index_ |
int | yaw_index_ |
int | z_index_ |
Definition at line 50 of file ompl_ros_rpy_ik_state_transformer.h.
ompl_ros_interface::OmplRosRPYIKStateTransformer::OmplRosRPYIKStateTransformer | ( | const ompl::base::StateSpacePtr & | state_space, | |
const planning_models::KinematicModel::JointModelGroup * | physical_joint_model_group | |||
) | [inline] |
Definition at line 57 of file ompl_ros_rpy_ik_state_transformer.h.
ompl_ros_interface::OmplRosRPYIKStateTransformer::~OmplRosRPYIKStateTransformer | ( | ) | [inline] |
Definition at line 61 of file ompl_ros_rpy_ik_state_transformer.h.
bool ompl_ros_interface::OmplRosRPYIKStateTransformer::configureOnRequest | ( | const motion_planning_msgs::GetMotionPlan::Request & | request, | |
motion_planning_msgs::GetMotionPlan::Response & | response | |||
) | [virtual] |
Configure the transformer when a request is received. This is typically a one time configuration for each planning request.
Implements ompl_ros_interface::OmplRosIKStateTransformer.
Definition at line 79 of file ompl_ros_rpy_ik_state_transformer.cpp.
bool ompl_ros_interface::OmplRosRPYIKStateTransformer::forwardTransform | ( | const motion_planning_msgs::RobotState & | robot_state, | |
ompl::base::State & | ompl_state | |||
) | [virtual] |
Compute the forward transform (from physical state to planning state).
Implements ompl_ros_interface::OmplRosIKStateTransformer.
Definition at line 105 of file ompl_ros_rpy_ik_state_transformer.cpp.
motion_planning_msgs::RobotState ompl_ros_interface::OmplRosRPYIKStateTransformer::getDefaultState | ( | ) | [virtual] |
Get a default physical state.
Implements ompl_ros_interface::OmplRosIKStateTransformer.
Definition at line 127 of file ompl_ros_rpy_ik_state_transformer.cpp.
bool ompl_ros_interface::OmplRosRPYIKStateTransformer::initialize | ( | ) | [virtual] |
Custom initialization can be performed here.
Implements ompl_ros_interface::OmplRosIKStateTransformer.
Definition at line 42 of file ompl_ros_rpy_ik_state_transformer.cpp.
bool ompl_ros_interface::OmplRosRPYIKStateTransformer::inverseTransform | ( | const ompl::base::State & | ompl_state, | |
motion_planning_msgs::RobotState & | robot_state | |||
) | [virtual] |
Compute the inverse transform (from planning state to physical state).
ompl_state | - the planning state | |
robot_State | - the corresponding physical state |
Implements ompl_ros_interface::OmplRosIKStateTransformer.
Definition at line 86 of file ompl_ros_rpy_ik_state_transformer.cpp.
void ompl_ros_interface::OmplRosRPYIKStateTransformer::omplStateToPose | ( | const ompl::base::State & | ompl_state, | |
geometry_msgs::Pose & | pose | |||
) | [private] |
Definition at line 111 of file ompl_ros_rpy_ik_state_transformer.cpp.
ompl_ros_interface::OmplStateToRobotStateMapping ompl_ros_interface::OmplRosRPYIKStateTransformer::ompl_state_to_robot_state_mapping_ [private] |
Definition at line 95 of file ompl_ros_rpy_ik_state_transformer.h.
Definition at line 92 of file ompl_ros_rpy_ik_state_transformer.h.
Definition at line 90 of file ompl_ros_rpy_ik_state_transformer.h.
ompl_ros_interface::RobotStateToOmplStateMapping ompl_ros_interface::OmplRosRPYIKStateTransformer::robot_state_to_ompl_state_mapping_ [private] |
Definition at line 96 of file ompl_ros_rpy_ik_state_transformer.h.
Definition at line 92 of file ompl_ros_rpy_ik_state_transformer.h.
boost::shared_ptr<ompl::base::ScopedState<ompl::base::CompoundStateSpace> > ompl_ros_interface::OmplRosRPYIKStateTransformer::scoped_state_ [private] |
Definition at line 93 of file ompl_ros_rpy_ik_state_transformer.h.
motion_planning_msgs::RobotState ompl_ros_interface::OmplRosRPYIKStateTransformer::seed_state_ [private] |
Definition at line 91 of file ompl_ros_rpy_ik_state_transformer.h.
motion_planning_msgs::RobotState ompl_ros_interface::OmplRosRPYIKStateTransformer::solution_state_ [private] |
Definition at line 91 of file ompl_ros_rpy_ik_state_transformer.h.
Definition at line 92 of file ompl_ros_rpy_ik_state_transformer.h.
Definition at line 92 of file ompl_ros_rpy_ik_state_transformer.h.
Definition at line 92 of file ompl_ros_rpy_ik_state_transformer.h.
Definition at line 92 of file ompl_ros_rpy_ik_state_transformer.h.