Public Member Functions | Public Attributes | Protected Types | Protected Member Functions | Protected Attributes | Private Slots
moveit_rviz_plugin::MotionPlanningDisplay Class Reference

#include <motion_planning_display.h>

Inheritance diagram for moveit_rviz_plugin::MotionPlanningDisplay:
Inheritance graph
[legend]

List of all members.

Public Member Functions

void addStatusText (const std::string &text)
void addStatusText (const std::vector< std::string > &text)
void changePlanningGroup (const std::string &group)
void clearPlaceLocationsDisplay ()
void dropVisualizedTrajectory ()
std::string getCurrentPlanningGroup () const
robot_state::RobotStateConstPtr getQueryGoalState () const
const
robot_interaction::RobotInteraction::InteractionHandlerPtr
getQueryGoalStateHandler () const
robot_state::RobotStateConstPtr getQueryStartState () const
const
robot_interaction::RobotInteraction::InteractionHandlerPtr
getQueryStartStateHandler () const
const
robot_interaction::RobotInteractionPtr & 
getRobotInteraction () const
virtual void load (const rviz::Config &config)
 MotionPlanningDisplay ()
virtual void reset ()
void resetStatusTextColor ()
virtual void save (rviz::Config config) const
void setName (const QString &name)
void setQueryGoalState (const robot_state::RobotState &goal)
void setQueryStartState (const robot_state::RobotState &start)
void setStatusTextColor (const QColor &color)
void toggleSelectPlanningGroupSubscription (bool enable)
virtual void update (float wall_dt, float ros_dt)
void updateQueryGoalState ()
void updateQueryStartState ()
void useApproximateIK (bool flag)
void visualizePlaceLocations (const std::vector< geometry_msgs::PoseStamped > &place_poses)
virtual ~MotionPlanningDisplay ()

Public Attributes

std::vector< boost::shared_ptr
< rviz::Shape > > 
place_locations_display_

Protected Types

enum  LinkDisplayStatus { COLLISION_LINK, OUTSIDE_BOUNDS_LINK }

Protected Member Functions

void backgroundJobUpdate (moveit::tools::BackgroundProcessing::JobEvent event, const std::string &jobname)
void computeMetrics (bool start, const std::string &group, double payload)
void computeMetricsInternal (std::map< std::string, double > &metrics, const robot_interaction::RobotInteraction::EndEffector &eef, const robot_state::RobotState &state, double payload)
void displayMetrics (bool start)
void displayTable (const std::map< std::string, double > &values, const Ogre::ColourValue &color, const Ogre::Vector3 &pos, const Ogre::Quaternion &orient)
void drawQueryGoalState ()
void drawQueryStartState ()
void executeMainLoopJobs ()
virtual void fixedFrameChanged ()
bool isIKSolutionCollisionFree (robot_state::RobotState *state, const robot_state::JointModelGroup *group, const double *ik_solution) const
virtual void onDisable ()
virtual void onEnable ()
virtual void onInitialize ()
virtual void onRobotModelLoaded ()
 This is an event called by loadRobotModel() in the MainLoop; do not call directly.
virtual void onSceneMonitorReceivedUpdate (planning_scene_monitor::PlanningSceneMonitor::SceneUpdateType update_type)
void populateMenuHandler (boost::shared_ptr< interactive_markers::MenuHandler > &mh)
void publishInteractiveMarkers (bool pose_update)
void recomputeQueryGoalStateMetrics ()
void recomputeQueryStartStateMetrics ()
void renderWorkspaceBox ()
void scheduleDrawQueryGoalState (robot_interaction::RobotInteraction::InteractionHandler *handler, bool error_state_changed)
void scheduleDrawQueryStartState (robot_interaction::RobotInteraction::InteractionHandler *handler, bool error_state_changed)
void selectPlanningGroupCallback (const std_msgs::StringConstPtr &msg)
void setQueryStateHelper (bool use_start_state, const std::string &v)
void updateBackgroundJobProgressBar ()
virtual void updateInternal (float wall_dt, float ros_dt)
void updateLinkColors ()
void updateStateExceptModified (robot_state::RobotState &dest, const robot_state::RobotState &src)

Protected Attributes

rviz::BoolPropertycompute_weight_limit_property_
std::map< std::pair< bool,
std::string >, std::map
< std::string, double > > 
computed_metrics_
std::map< std::string,
dynamics_solver::DynamicsSolverPtr > 
dynamics_solver_
MotionPlanningFrameframe_
rviz::PanelDockWidgetframe_dock_
rviz::Displayint_marker_display_
kinematics_metrics::KinematicsMetricsPtr kinematics_metrics_
boost::shared_ptr
< interactive_markers::MenuHandler
menu_handler_goal_
boost::shared_ptr
< interactive_markers::MenuHandler
menu_handler_start_
rviz::Propertymetrics_category_
rviz::FloatPropertymetrics_set_payload_property_
rviz::FloatPropertymetrics_text_height_property_
std::set< std::string > modified_groups_
ros::NodeHandle node_handle_
rviz::Propertypath_category_
rviz::Propertyplan_category_
rviz::EditableEnumPropertyplanning_group_property_
ros::Subscriber planning_group_sub_
std::map< std::string, bool > position_only_ik_
 Some groups use position only ik, calls to the metrics have to be modified appropriately.
ros::NodeHandle private_handle_
rviz::ColorPropertyquery_colliding_link_color_property_
rviz::FloatPropertyquery_goal_alpha_property_
rviz::ColorPropertyquery_goal_color_property_
robot_interaction::RobotInteraction::InteractionHandlerPtr query_goal_state_
rviz::BoolPropertyquery_goal_state_property_
rviz::FloatPropertyquery_marker_scale_property_
rviz::ColorPropertyquery_outside_joint_limits_link_color_property_
RobotStateVisualizationPtr query_robot_goal_
 Handles drawing the robot at the goal configuration.
RobotStateVisualizationPtr query_robot_start_
 Handles drawing the robot at the start configuration.
rviz::FloatPropertyquery_start_alpha_property_
rviz::ColorPropertyquery_start_color_property_
robot_interaction::RobotInteraction::InteractionHandlerPtr query_start_state_
rviz::BoolPropertyquery_start_state_property_
robot_interaction::RobotInteractionPtr robot_interaction_
rviz::BoolPropertyshow_joint_torques_property_
rviz::BoolPropertyshow_manipulability_index_property_
rviz::BoolPropertyshow_manipulability_property_
rviz::BoolPropertyshow_workspace_property_
std::map< std::string,
LinkDisplayStatus
status_links_goal_
std::map< std::string,
LinkDisplayStatus
status_links_start_
bool text_display_for_start_
 indicates whether the text display is for the start state or not
Ogre::SceneNode * text_display_scene_node_
 displays texts
rviz::MovableTexttext_to_display_
TrajectoryVisualizationPtr trajectory_visual_
boost::mutex update_metrics_lock_
boost::scoped_ptr< rviz::Shapeworkspace_box_

Private Slots

void changedMetricsSetPayload ()
void changedMetricsTextHeight ()
void changedPlanningGroup ()
void changedQueryCollidingLinkColor ()
void changedQueryGoalAlpha ()
void changedQueryGoalColor ()
void changedQueryGoalState ()
void changedQueryJointViolationColor ()
void changedQueryMarkerScale ()
void changedQueryStartAlpha ()
void changedQueryStartColor ()
void changedQueryStartState ()
void changedShowJointTorques ()
void changedShowManipulability ()
void changedShowManipulabilityIndex ()
void changedShowWeightLimit ()
void changedWorkspace ()
void motionPanelVisibilityChange (bool enable)
void resetInteractiveMarkers ()

Detailed Description

Definition at line 81 of file motion_planning_display.h.


Member Enumeration Documentation

Enumerator:
COLLISION_LINK 
OUTSIDE_BOUNDS_LINK 

Definition at line 179 of file motion_planning_display.h.


Constructor & Destructor Documentation

Definition at line 81 of file motion_planning_display.cpp.

Definition at line 178 of file motion_planning_display.cpp.


Member Function Documentation

Definition at line 687 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::addStatusText ( const std::vector< std::string > &  text)

Definition at line 693 of file motion_planning_display.cpp.

Definition at line 319 of file motion_planning_display.cpp.

Definition at line 415 of file motion_planning_display.cpp.

Definition at line 429 of file motion_planning_display.cpp.

Definition at line 1020 of file motion_planning_display.cpp.

Definition at line 885 of file motion_planning_display.cpp.

Definition at line 879 of file motion_planning_display.cpp.

Definition at line 867 of file motion_planning_display.cpp.

Definition at line 724 of file motion_planning_display.cpp.

Definition at line 891 of file motion_planning_display.cpp.

Definition at line 855 of file motion_planning_display.cpp.

Definition at line 849 of file motion_planning_display.cpp.

Definition at line 837 of file motion_planning_display.cpp.

Definition at line 713 of file motion_planning_display.cpp.

Definition at line 401 of file motion_planning_display.cpp.

Definition at line 387 of file motion_planning_display.cpp.

Definition at line 373 of file motion_planning_display.cpp.

Definition at line 359 of file motion_planning_display.cpp.

Definition at line 1046 of file motion_planning_display.cpp.

Definition at line 1006 of file motion_planning_display.cpp.

Definition at line 1383 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::computeMetrics ( bool  start,
const std::string &  group,
double  payload 
) [protected]

Definition at line 479 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::computeMetricsInternal ( std::map< std::string, double > &  metrics,
const robot_interaction::RobotInteraction::EndEffector eef,
const robot_state::RobotState &  state,
double  payload 
) [protected]

Definition at line 495 of file motion_planning_display.cpp.

Definition at line 555 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::displayTable ( const std::map< std::string, double > &  values,
const Ogre::ColourValue &  color,
const Ogre::Vector3 pos,
const Ogre::Quaternion &  orient 
) [protected]

Definition at line 434 of file motion_planning_display.cpp.

Definition at line 735 of file motion_planning_display.cpp.

Definition at line 613 of file motion_planning_display.cpp.

Definition at line 123 of file motion_planning_display.h.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1374 of file motion_planning_display.cpp.

Definition at line 1051 of file motion_planning_display.cpp.

robot_state::RobotStateConstPtr moveit_rviz_plugin::MotionPlanningDisplay::getQueryGoalState ( ) const [inline]

Definition at line 103 of file motion_planning_display.h.

Definition at line 118 of file motion_planning_display.h.

robot_state::RobotStateConstPtr moveit_rviz_plugin::MotionPlanningDisplay::getQueryStartState ( ) const [inline]

Definition at line 98 of file motion_planning_display.h.

Definition at line 113 of file motion_planning_display.h.

const robot_interaction::RobotInteractionPtr& moveit_rviz_plugin::MotionPlanningDisplay::getRobotInteraction ( ) const [inline]

Definition at line 108 of file motion_planning_display.h.

bool moveit_rviz_plugin::MotionPlanningDisplay::isIKSolutionCollisionFree ( robot_state::RobotState *  state,
const robot_state::JointModelGroup *  group,
const double *  ik_solution 
) const [protected]

Definition at line 963 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1285 of file motion_planning_display.cpp.

Definition at line 256 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1246 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1227 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 192 of file motion_planning_display.cpp.

This is an event called by loadRobotModel() in the MainLoop; do not call directly.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1123 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1199 of file motion_planning_display.cpp.

Definition at line 1091 of file motion_planning_display.cpp.

Definition at line 808 of file motion_planning_display.cpp.

Definition at line 706 of file motion_planning_display.cpp.

Definition at line 699 of file motion_planning_display.cpp.

Definition at line 457 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 289 of file motion_planning_display.cpp.

Definition at line 800 of file motion_planning_display.cpp.

Definition at line 676 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1350 of file motion_planning_display.cpp.

Definition at line 909 of file motion_planning_display.cpp.

Definition at line 897 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::selectPlanningGroupCallback ( const std_msgs::StringConstPtr &  msg) [protected]

Definition at line 275 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::setName ( const QString &  name) [virtual]

Reimplemented from rviz::Display.

Definition at line 308 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::setQueryGoalState ( const robot_state::RobotState &  goal)

Definition at line 941 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::setQueryStartState ( const robot_state::RobotState &  start)

Definition at line 935 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::setQueryStateHelper ( bool  use_start_state,
const std::string &  v 
) [protected]

Definition at line 1056 of file motion_planning_display.cpp.

Definition at line 681 of file motion_planning_display.cpp.

Definition at line 262 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::update ( float  wall_dt,
float  ros_dt 
) [virtual]

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1265 of file motion_planning_display.cpp.

Definition at line 324 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::updateInternal ( float  wall_dt,
float  ros_dt 
) [protected, virtual]

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1275 of file motion_planning_display.cpp.

Definition at line 978 of file motion_planning_display.cpp.

Definition at line 928 of file motion_planning_display.cpp.

Definition at line 921 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::updateStateExceptModified ( robot_state::RobotState &  dest,
const robot_state::RobotState &  src 
) [protected]

Definition at line 1181 of file motion_planning_display.cpp.

Definition at line 947 of file motion_planning_display.cpp.

void moveit_rviz_plugin::MotionPlanningDisplay::visualizePlaceLocations ( const std::vector< geometry_msgs::PoseStamped > &  place_poses)

Definition at line 1390 of file motion_planning_display.cpp.


Member Data Documentation

Definition at line 290 of file motion_planning_display.h.

std::map<std::pair<bool, std::string>, std::map<std::string, double> > moveit_rviz_plugin::MotionPlanningDisplay::computed_metrics_ [protected]

The metrics are pairs of name-value for each of the active end effectors, for both start & goal states. computed_metrics_[std::make_pair(IS_START_STATE, GROUP_NAME)] = a map of key-value pairs

Definition at line 262 of file motion_planning_display.h.

std::map<std::string, dynamics_solver::DynamicsSolverPtr> moveit_rviz_plugin::MotionPlanningDisplay::dynamics_solver_ [protected]

Definition at line 268 of file motion_planning_display.h.

Definition at line 244 of file motion_planning_display.h.

Definition at line 245 of file motion_planning_display.h.

Definition at line 298 of file motion_planning_display.h.

kinematics_metrics::KinematicsMetricsPtr moveit_rviz_plugin::MotionPlanningDisplay::kinematics_metrics_ [protected]

Definition at line 267 of file motion_planning_display.h.

Definition at line 252 of file motion_planning_display.h.

Definition at line 251 of file motion_planning_display.h.

Definition at line 277 of file motion_planning_display.h.

Definition at line 294 of file motion_planning_display.h.

Definition at line 295 of file motion_planning_display.h.

Hold the names of the groups for which the query states have been updated (and should not be altered when new info is received from the planning scene)

Definition at line 258 of file motion_planning_display.h.

Definition at line 238 of file motion_planning_display.h.

Definition at line 275 of file motion_planning_display.h.

Definition at line 139 of file motion_planning_display.h.

Definition at line 276 of file motion_planning_display.h.

Definition at line 279 of file motion_planning_display.h.

Definition at line 237 of file motion_planning_display.h.

std::map<std::string, bool> moveit_rviz_plugin::MotionPlanningDisplay::position_only_ik_ [protected]

Some groups use position only ik, calls to the metrics have to be modified appropriately.

Definition at line 264 of file motion_planning_display.h.

Definition at line 238 of file motion_planning_display.h.

Definition at line 287 of file motion_planning_display.h.

Definition at line 286 of file motion_planning_display.h.

Definition at line 284 of file motion_planning_display.h.

Definition at line 250 of file motion_planning_display.h.

Definition at line 281 of file motion_planning_display.h.

Definition at line 282 of file motion_planning_display.h.

Definition at line 288 of file motion_planning_display.h.

RobotStateVisualizationPtr moveit_rviz_plugin::MotionPlanningDisplay::query_robot_goal_ [protected]

Handles drawing the robot at the goal configuration.

Definition at line 231 of file motion_planning_display.h.

RobotStateVisualizationPtr moveit_rviz_plugin::MotionPlanningDisplay::query_robot_start_ [protected]

Handles drawing the robot at the start configuration.

Definition at line 230 of file motion_planning_display.h.

Definition at line 285 of file motion_planning_display.h.

Definition at line 283 of file motion_planning_display.h.

Definition at line 249 of file motion_planning_display.h.

Definition at line 280 of file motion_planning_display.h.

robot_interaction::RobotInteractionPtr moveit_rviz_plugin::MotionPlanningDisplay::robot_interaction_ [protected]

Definition at line 248 of file motion_planning_display.h.

Definition at line 293 of file motion_planning_display.h.

Definition at line 291 of file motion_planning_display.h.

Definition at line 292 of file motion_planning_display.h.

Definition at line 296 of file motion_planning_display.h.

Definition at line 254 of file motion_planning_display.h.

Definition at line 253 of file motion_planning_display.h.

indicates whether the text display is for the start state or not

Definition at line 234 of file motion_planning_display.h.

displays texts

Definition at line 233 of file motion_planning_display.h.

Definition at line 235 of file motion_planning_display.h.

TrajectoryVisualizationPtr moveit_rviz_plugin::MotionPlanningDisplay::trajectory_visual_ [protected]

Definition at line 272 of file motion_planning_display.h.

Definition at line 269 of file motion_planning_display.h.

Definition at line 241 of file motion_planning_display.h.


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


visualization
Author(s): Ioan Sucan , Dave Coleman , Sachin Chitta
autogenerated on Mon Jul 24 2017 02:22:14