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 180 of file motion_planning_display.cpp.


Member Function Documentation

Definition at line 689 of file motion_planning_display.cpp.

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

Definition at line 695 of file motion_planning_display.cpp.

Definition at line 321 of file motion_planning_display.cpp.

Definition at line 417 of file motion_planning_display.cpp.

Definition at line 431 of file motion_planning_display.cpp.

Definition at line 1022 of file motion_planning_display.cpp.

Definition at line 887 of file motion_planning_display.cpp.

Definition at line 881 of file motion_planning_display.cpp.

Definition at line 869 of file motion_planning_display.cpp.

Definition at line 726 of file motion_planning_display.cpp.

Definition at line 893 of file motion_planning_display.cpp.

Definition at line 857 of file motion_planning_display.cpp.

Definition at line 851 of file motion_planning_display.cpp.

Definition at line 839 of file motion_planning_display.cpp.

Definition at line 715 of file motion_planning_display.cpp.

Definition at line 403 of file motion_planning_display.cpp.

Definition at line 389 of file motion_planning_display.cpp.

Definition at line 375 of file motion_planning_display.cpp.

Definition at line 361 of file motion_planning_display.cpp.

Definition at line 1048 of file motion_planning_display.cpp.

Definition at line 1008 of file motion_planning_display.cpp.

Definition at line 1387 of file motion_planning_display.cpp.

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

Definition at line 481 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 497 of file motion_planning_display.cpp.

Definition at line 557 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 436 of file motion_planning_display.cpp.

Definition at line 737 of file motion_planning_display.cpp.

Definition at line 615 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 1378 of file motion_planning_display.cpp.

Definition at line 1053 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 965 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1289 of file motion_planning_display.cpp.

Definition at line 258 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1249 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1229 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 194 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 1125 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1201 of file motion_planning_display.cpp.

Definition at line 1093 of file motion_planning_display.cpp.

Definition at line 810 of file motion_planning_display.cpp.

Definition at line 708 of file motion_planning_display.cpp.

Definition at line 701 of file motion_planning_display.cpp.

Definition at line 459 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 291 of file motion_planning_display.cpp.

Definition at line 802 of file motion_planning_display.cpp.

Definition at line 678 of file motion_planning_display.cpp.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1354 of file motion_planning_display.cpp.

Definition at line 911 of file motion_planning_display.cpp.

Definition at line 899 of file motion_planning_display.cpp.

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

Definition at line 277 of file motion_planning_display.cpp.

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

Reimplemented from rviz::Display.

Definition at line 310 of file motion_planning_display.cpp.

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

Definition at line 943 of file motion_planning_display.cpp.

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

Definition at line 937 of file motion_planning_display.cpp.

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

Definition at line 1058 of file motion_planning_display.cpp.

Definition at line 683 of file motion_planning_display.cpp.

Definition at line 264 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 1269 of file motion_planning_display.cpp.

Definition at line 326 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 1279 of file motion_planning_display.cpp.

Definition at line 980 of file motion_planning_display.cpp.

Definition at line 930 of file motion_planning_display.cpp.

Definition at line 923 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 1183 of file motion_planning_display.cpp.

Definition at line 949 of file motion_planning_display.cpp.

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

Definition at line 1394 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 Wed Jun 19 2019 19:25:00