moveit2
The MoveIt Motion Planning Framework for ROS 2.
Loading...
Searching...
No Matches
Signals | Public Member Functions | Public Attributes | Protected Types | Protected Member Functions | Protected Attributes | List of all members
moveit_rviz_plugin::MotionPlanningDisplay Class Reference

#include <motion_planning_display.h>

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

Signals

void queryStartStateChanged ()
 
void queryGoalStateChanged ()
 

Public Member Functions

 MotionPlanningDisplay ()
 
 ~MotionPlanningDisplay () override
 
void load (const rviz_common::Config &config) override
 
void save (rviz_common::Config config) const override
 
void update (float wall_dt, float ros_dt) override
 
void reset () override
 
moveit::core::RobotStateConstPtr getQueryStartState () const
 
moveit::core::RobotStateConstPtr getQueryGoalState () const
 
const moveit::core::RobotStategetPreviousState () const
 
const robot_interaction::RobotInteractionPtr & getRobotInteraction () const
 
const robot_interaction::InteractionHandlerPtr & getQueryStartStateHandler () const
 
const robot_interaction::InteractionHandlerPtr & getQueryGoalStateHandler () const
 
void dropVisualizedTrajectory ()
 
void setQueryStartState (const moveit::core::RobotState &start)
 
void setQueryGoalState (const moveit::core::RobotState &goal)
 
void updateQueryStates (const moveit::core::RobotState &current_state)
 
void updateQueryStartState ()
 
void updateQueryGoalState ()
 
void rememberPreviousStartState ()
 
void useApproximateIK (bool flag)
 
void clearPlaceLocationsDisplay ()
 
void visualizePlaceLocations (const std::vector< geometry_msgs::msg::PoseStamped > &place_poses)
 
std::string getCurrentPlanningGroup () const
 
void changePlanningGroup (const std::string &group)
 
void addStatusText (const std::string &text)
 
void addStatusText (const std::vector< std::string > &text)
 
void setStatusTextColor (const QColor &color)
 
void resetStatusTextColor ()
 
void toggleSelectPlanningGroupSubscription (bool enable)
 
- Public Member Functions inherited from moveit_rviz_plugin::PlanningSceneDisplay
 PlanningSceneDisplay (bool listen_to_planning_scene=true, bool show_scene_robot=true)
 
 ~PlanningSceneDisplay () override
 
void load (const rviz_common::Config &config) override
 
void save (rviz_common::Config config) const override
 
void update (float wall_dt, float ros_dt) override
 
void reset () override
 
void setLinkColor (const std::string &link_name, const QColor &color)
 
void unsetLinkColor (const std::string &link_name)
 
void queueRenderSceneGeometry ()
 
void addBackgroundJob (const std::function< void()> &job, const std::string &name)
 
void spawnBackgroundJob (const std::function< void()> &job)
 
void addMainLoopJob (const std::function< void()> &job)
 queue the execution of this function for the next time the main update() loop gets called
 
void waitForAllMainLoopJobs ()
 
void clearJobs ()
 remove all queued jobs
 
const std::string getMoveGroupNS () const
 
const moveit::core::RobotModelConstPtr & getRobotModel () const
 
bool waitForCurrentRobotState (const rclcpp::Time &t)
 wait for robot state more recent than t
 
planning_scene_monitor::LockedPlanningSceneRO getPlanningSceneRO () const
 get read-only access to planning scene
 
planning_scene_monitor::LockedPlanningSceneRW getPlanningSceneRW ()
 get write access to planning scene
 
const planning_scene_monitor::PlanningSceneMonitorPtr & getPlanningSceneMonitor ()
 

Public Attributes

std::vector< std::shared_ptr< rviz_rendering::Shape > > place_locations_display_
 

Protected Types

enum  LinkDisplayStatus { COLLISION_LINK , OUTSIDE_BOUNDS_LINK }
 

Protected Member Functions

void clearRobotModel () override
 
void onRobotModelLoaded () override
 This is an event called by loadRobotModel() in the MainLoop; do not call directly.
 
void onNewPlanningSceneState () override
 This is called upon successful retrieval of the (initial) planning scene state.
 
void onSceneMonitorReceivedUpdate (planning_scene_monitor::PlanningSceneMonitor::SceneUpdateType update_type) override
 
void updateInternal (double wall_dt, double ros_dt) override
 
void renderWorkspaceBox ()
 
void updateLinkColors ()
 
void displayTable (const std::map< std::string, double > &values, const Ogre::ColourValue &color, const Ogre::Vector3 &pos, const Ogre::Quaternion &orient)
 
void displayMetrics (bool start)
 
void executeMainLoopJobs ()
 
void publishInteractiveMarkers (bool pose_update)
 
void recomputeQueryStartStateMetrics ()
 
void recomputeQueryGoalStateMetrics ()
 
void drawQueryStartState ()
 
void drawQueryGoalState ()
 
void scheduleDrawQueryStartState (robot_interaction::InteractionHandler *handler, bool error_state_changed)
 
void scheduleDrawQueryGoalState (robot_interaction::InteractionHandler *handler, bool error_state_changed)
 
bool isIKSolutionCollisionFree (moveit::core::RobotState *state, const moveit::core::JointModelGroup *group, const double *ik_solution) const
 
void computeMetrics (bool start, const std::string &group, double payload)
 
void computeMetricsInternal (std::map< std::string, double > &metrics, const robot_interaction::EndEffectorInteraction &eef, const moveit::core::RobotState &state, double payload)
 
void updateStateExceptModified (moveit::core::RobotState &dest, const moveit::core::RobotState &src)
 
void updateBackgroundJobProgressBar ()
 
void backgroundJobUpdate (moveit::tools::BackgroundProcessing::JobEvent event, const std::string &jobname)
 
void setQueryStateHelper (bool use_start_state, const std::string &v)
 
void populateMenuHandler (std::shared_ptr< interactive_markers::MenuHandler > &mh)
 
void selectPlanningGroupCallback (const std_msgs::msg::String::ConstSharedPtr &msg)
 
void onInitialize () override
 
void onEnable () override
 
void onDisable () override
 
void fixedFrameChanged () override
 
- Protected Member Functions inherited from moveit_rviz_plugin::PlanningSceneDisplay
void loadRobotModel ()
 
virtual planning_scene_monitor::PlanningSceneMonitorPtr createPlanningSceneMonitor ()
 
void calculateOffsetPosition ()
 Set the scene node's position, given the target frame and the planning frame.
 
void executeMainLoopJobs ()
 
void sceneMonitorReceivedUpdate (planning_scene_monitor::PlanningSceneMonitor::SceneUpdateType update_type)
 
void renderPlanningScene ()
 
void setLinkColor (rviz_default_plugins::robot::Robot *robot, const std::string &link_name, const QColor &color)
 
void unsetLinkColor (rviz_default_plugins::robot::Robot *robot, const std::string &link_name)
 
void setGroupColor (rviz_default_plugins::robot::Robot *robot, const std::string &group_name, const QColor &color)
 
void unsetGroupColor (rviz_default_plugins::robot::Robot *robot, const std::string &group_name)
 
void unsetAllColors (rviz_default_plugins::robot::Robot *robot)
 
void onInitialize () override
 
void onEnable () override
 
void onDisable () override
 
void fixedFrameChanged () override
 

Protected Attributes

RobotStateVisualizationPtr query_robot_start_
 Handles drawing the robot at the start configuration.
 
RobotStateVisualizationPtr query_robot_goal_
 Handles drawing the robot at the goal configuration.
 
Ogre::SceneNode * text_display_scene_node_
 displays texts
 
bool text_display_for_start_
 indicates whether the text display is for the start state or not
 
rviz_rendering::MovableText * text_to_display_
 
rclcpp::Subscription< std_msgs::msg::String >::SharedPtr planning_group_sub_
 
std::unique_ptr< rviz_rendering::Shape > workspace_box_
 
MotionPlanningFrameframe_
 
rviz_common::PanelDockWidget * frame_dock_
 
robot_interaction::RobotInteractionPtr robot_interaction_
 
robot_interaction::InteractionHandlerPtr query_start_state_
 
robot_interaction::InteractionHandlerPtr query_goal_state_
 
std::shared_ptr< interactive_markers::MenuHandler > menu_handler_start_
 
std::shared_ptr< interactive_markers::MenuHandler > menu_handler_goal_
 
std::map< std::string, LinkDisplayStatusstatus_links_start_
 
std::map< std::string, LinkDisplayStatusstatus_links_goal_
 
moveit::core::RobotStatePtr previous_state_
 remember previous start state (updated before starting execution)
 
std::set< std::string > modified_groups_
 
std::map< std::pair< bool, std::string >, std::map< std::string, double > > computed_metrics_
 
std::map< std::string, bool > position_only_ik_
 Some groups use position only ik, calls to the metrics have to be modified appropriately.
 
kinematics_metrics::KinematicsMetricsPtr kinematics_metrics_
 
std::map< std::string, dynamics_solver::DynamicsSolverPtr > dynamics_solver_
 
std::mutex update_metrics_lock_
 
TrajectoryVisualizationPtr trajectory_visual_
 
rviz_common::properties::Property * path_category_
 
rviz_common::properties::Property * plan_category_
 
rviz_common::properties::Property * metrics_category_
 
rviz_common::properties::EditableEnumProperty * planning_group_property_
 
rviz_common::properties::BoolProperty * query_start_state_property_
 
rviz_common::properties::BoolProperty * query_goal_state_property_
 
rviz_common::properties::FloatProperty * query_marker_scale_property_
 
rviz_common::properties::ColorProperty * query_start_color_property_
 
rviz_common::properties::ColorProperty * query_goal_color_property_
 
rviz_common::properties::FloatProperty * query_start_alpha_property_
 
rviz_common::properties::FloatProperty * query_goal_alpha_property_
 
rviz_common::properties::ColorProperty * query_colliding_link_color_property_
 
rviz_common::properties::ColorProperty * query_outside_joint_limits_link_color_property_
 
rviz_common::properties::BoolProperty * compute_weight_limit_property_
 
rviz_common::properties::BoolProperty * show_manipulability_index_property_
 
rviz_common::properties::BoolProperty * show_manipulability_property_
 
rviz_common::properties::BoolProperty * show_joint_torques_property_
 
rviz_common::properties::FloatProperty * metrics_set_payload_property_
 
rviz_common::properties::FloatProperty * metrics_text_height_property_
 
rviz_common::properties::BoolProperty * show_workspace_property_
 
rviz_common::Display * int_marker_display_
 
- Protected Attributes inherited from moveit_rviz_plugin::PlanningSceneDisplay
planning_scene_monitor::PlanningSceneMonitorPtr planning_scene_monitor_
 
std::mutex robot_model_loading_lock_
 
moveit::tools::BackgroundProcessing background_process_
 
std::deque< std::function< void()> > main_loop_jobs_
 
std::mutex main_loop_jobs_lock_
 
std::condition_variable main_loop_jobs_empty_condition_
 
Ogre::SceneNode * planning_scene_node_
 displays planning scene with everything in it
 
RobotStateVisualizationPtr planning_scene_robot_
 
PlanningSceneRenderPtr planning_scene_render_
 
bool planning_scene_needs_render_
 
bool robot_state_needs_render_
 
double current_scene_time_
 
rviz_common::properties::Property * scene_category_
 
rviz_common::properties::Property * robot_category_
 
rviz_common::properties::StringProperty * move_group_ns_property_
 
rviz_common::properties::StringProperty * robot_description_property_
 
rviz_common::properties::StringProperty * scene_name_property_
 
rviz_common::properties::BoolProperty * scene_enabled_property_
 
rviz_common::properties::BoolProperty * scene_robot_visual_enabled_property_
 
rviz_common::properties::BoolProperty * scene_robot_collision_enabled_property_
 
rviz_common::properties::RosTopicProperty * planning_scene_topic_property_
 
rviz_common::properties::FloatProperty * robot_alpha_property_
 
rviz_common::properties::FloatProperty * scene_alpha_property_
 
rviz_common::properties::ColorProperty * scene_color_property_
 
rviz_common::properties::ColorProperty * attached_body_color_property_
 
rviz_common::properties::FloatProperty * scene_display_time_property_
 
rviz_common::properties::EnumProperty * octree_render_property_
 
rviz_common::properties::EnumProperty * octree_coloring_property_
 
rclcpp::Node::SharedPtr node_
 
rclcpp::Logger logger_
 

Additional Inherited Members

- Protected Slots inherited from moveit_rviz_plugin::PlanningSceneDisplay
virtual void changedAttachedBodyColor ()
 

Detailed Description

Definition at line 97 of file motion_planning_display.h.

Member Enumeration Documentation

◆ LinkDisplayStatus

Enumerator
COLLISION_LINK 
OUTSIDE_BOUNDS_LINK 

Definition at line 206 of file motion_planning_display.h.

Constructor & Destructor Documentation

◆ MotionPlanningDisplay()

moveit_rviz_plugin::MotionPlanningDisplay::MotionPlanningDisplay ( )

Definition at line 80 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ ~MotionPlanningDisplay()

moveit_rviz_plugin::MotionPlanningDisplay::~MotionPlanningDisplay ( )
override

Definition at line 189 of file motion_planning_display.cpp.

Here is the call graph for this function:

Member Function Documentation

◆ addStatusText() [1/2]

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

Definition at line 693 of file motion_planning_display.cpp.

Here is the caller graph for this function:

◆ addStatusText() [2/2]

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

Definition at line 699 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ backgroundJobUpdate()

void moveit_rviz_plugin::MotionPlanningDisplay::backgroundJobUpdate ( moveit::tools::BackgroundProcessing::JobEvent  event,
const std::string &  jobname 
)
protected

Definition at line 320 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ changePlanningGroup()

void moveit_rviz_plugin::MotionPlanningDisplay::changePlanningGroup ( const std::string &  group)

Definition at line 1030 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ clearPlaceLocationsDisplay()

void moveit_rviz_plugin::MotionPlanningDisplay::clearPlaceLocationsDisplay ( )

Definition at line 1466 of file motion_planning_display.cpp.

Here is the caller graph for this function:

◆ clearRobotModel()

void moveit_rviz_plugin::MotionPlanningDisplay::clearRobotModel ( )
overrideprotectedvirtual

This function is used by loadRobotModel() and should only be called in the MainLoop You probably should not call this function directly

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1147 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ computeMetrics()

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

Definition at line 477 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ computeMetricsInternal()

void moveit_rviz_plugin::MotionPlanningDisplay::computeMetricsInternal ( std::map< std::string, double > &  metrics,
const robot_interaction::EndEffectorInteraction eef,
const moveit::core::RobotState state,
double  payload 
)
protected

Definition at line 494 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ displayMetrics()

void moveit_rviz_plugin::MotionPlanningDisplay::displayMetrics ( bool  start)
protected

Definition at line 554 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ displayTable()

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

Here is the caller graph for this function:

◆ drawQueryGoalState()

void moveit_rviz_plugin::MotionPlanningDisplay::drawQueryGoalState ( )
protected

Definition at line 739 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ drawQueryStartState()

void moveit_rviz_plugin::MotionPlanningDisplay::drawQueryStartState ( )
protected

Definition at line 617 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ dropVisualizedTrajectory()

void moveit_rviz_plugin::MotionPlanningDisplay::dropVisualizedTrajectory ( )
inline

Definition at line 142 of file motion_planning_display.h.

◆ executeMainLoopJobs()

void moveit_rviz_plugin::MotionPlanningDisplay::executeMainLoopJobs ( )
protected

◆ fixedFrameChanged()

void moveit_rviz_plugin::MotionPlanningDisplay::fixedFrameChanged ( )
overrideprotected

Definition at line 1451 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ getCurrentPlanningGroup()

std::string moveit_rviz_plugin::MotionPlanningDisplay::getCurrentPlanningGroup ( ) const

Definition at line 1075 of file motion_planning_display.cpp.

Here is the caller graph for this function:

◆ getPreviousState()

const moveit::core::RobotState & moveit_rviz_plugin::MotionPlanningDisplay::getPreviousState ( ) const
inline

Definition at line 122 of file motion_planning_display.h.

◆ getQueryGoalState()

moveit::core::RobotStateConstPtr moveit_rviz_plugin::MotionPlanningDisplay::getQueryGoalState ( ) const
inline

Definition at line 117 of file motion_planning_display.h.

Here is the caller graph for this function:

◆ getQueryGoalStateHandler()

const robot_interaction::InteractionHandlerPtr & moveit_rviz_plugin::MotionPlanningDisplay::getQueryGoalStateHandler ( ) const
inline

Definition at line 137 of file motion_planning_display.h.

◆ getQueryStartState()

moveit::core::RobotStateConstPtr moveit_rviz_plugin::MotionPlanningDisplay::getQueryStartState ( ) const
inline

Definition at line 112 of file motion_planning_display.h.

Here is the caller graph for this function:

◆ getQueryStartStateHandler()

const robot_interaction::InteractionHandlerPtr & moveit_rviz_plugin::MotionPlanningDisplay::getQueryStartStateHandler ( ) const
inline

Definition at line 132 of file motion_planning_display.h.

◆ getRobotInteraction()

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

Definition at line 127 of file motion_planning_display.h.

◆ isIKSolutionCollisionFree()

bool moveit_rviz_plugin::MotionPlanningDisplay::isIKSolutionCollisionFree ( moveit::core::RobotState state,
const moveit::core::JointModelGroup group,
const double *  ik_solution 
) const
protected

Definition at line 975 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ load()

void moveit_rviz_plugin::MotionPlanningDisplay::load ( const rviz_common::Config &  config)
override

Definition at line 1358 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ onDisable()

void moveit_rviz_plugin::MotionPlanningDisplay::onDisable ( )
overrideprotected

Definition at line 1317 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ onEnable()

void moveit_rviz_plugin::MotionPlanningDisplay::onEnable ( )
overrideprotected

Definition at line 1296 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ onInitialize()

void moveit_rviz_plugin::MotionPlanningDisplay::onInitialize ( )
overrideprotected

Definition at line 202 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ onNewPlanningSceneState()

void moveit_rviz_plugin::MotionPlanningDisplay::onNewPlanningSceneState ( )
overrideprotectedvirtual

This is called upon successful retrieval of the (initial) planning scene state.

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1241 of file motion_planning_display.cpp.

◆ onRobotModelLoaded()

void moveit_rviz_plugin::MotionPlanningDisplay::onRobotModelLoaded ( )
overrideprotectedvirtual

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

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1164 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ onSceneMonitorReceivedUpdate()

void moveit_rviz_plugin::MotionPlanningDisplay::onSceneMonitorReceivedUpdate ( planning_scene_monitor::PlanningSceneMonitor::SceneUpdateType  update_type)
overrideprotectedvirtual

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1284 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ populateMenuHandler()

void moveit_rviz_plugin::MotionPlanningDisplay::populateMenuHandler ( std::shared_ptr< interactive_markers::MenuHandler > &  mh)
protected

Definition at line 1115 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ publishInteractiveMarkers()

void moveit_rviz_plugin::MotionPlanningDisplay::publishInteractiveMarkers ( bool  pose_update)
protected

Definition at line 813 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ queryGoalStateChanged

void moveit_rviz_plugin::MotionPlanningDisplay::queryGoalStateChanged ( )
signal
Here is the caller graph for this function:

◆ queryStartStateChanged

void moveit_rviz_plugin::MotionPlanningDisplay::queryStartStateChanged ( )
signal
Here is the caller graph for this function:

◆ recomputeQueryGoalStateMetrics()

void moveit_rviz_plugin::MotionPlanningDisplay::recomputeQueryGoalStateMetrics ( )
protected

Definition at line 712 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ recomputeQueryStartStateMetrics()

void moveit_rviz_plugin::MotionPlanningDisplay::recomputeQueryStartStateMetrics ( )
protected

Definition at line 705 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ rememberPreviousStartState()

void moveit_rviz_plugin::MotionPlanningDisplay::rememberPreviousStartState ( )

Definition at line 946 of file motion_planning_display.cpp.

◆ renderWorkspaceBox()

void moveit_rviz_plugin::MotionPlanningDisplay::renderWorkspaceBox ( )
protected

Definition at line 454 of file motion_planning_display.cpp.

Here is the caller graph for this function:

◆ reset()

void moveit_rviz_plugin::MotionPlanningDisplay::reset ( )
override

Definition at line 298 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ resetStatusTextColor()

void moveit_rviz_plugin::MotionPlanningDisplay::resetStatusTextColor ( )

Definition at line 682 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ save()

void moveit_rviz_plugin::MotionPlanningDisplay::save ( rviz_common::Config  config) const
override

Definition at line 1421 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ scheduleDrawQueryGoalState()

void moveit_rviz_plugin::MotionPlanningDisplay::scheduleDrawQueryGoalState ( robot_interaction::InteractionHandler handler,
bool  error_state_changed 
)
protected

Definition at line 920 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ scheduleDrawQueryStartState()

void moveit_rviz_plugin::MotionPlanningDisplay::scheduleDrawQueryStartState ( robot_interaction::InteractionHandler handler,
bool  error_state_changed 
)
protected

Definition at line 910 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ selectPlanningGroupCallback()

void moveit_rviz_plugin::MotionPlanningDisplay::selectPlanningGroupCallback ( const std_msgs::msg::String::ConstSharedPtr &  msg)
protected

Definition at line 292 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ setQueryGoalState()

void moveit_rviz_plugin::MotionPlanningDisplay::setQueryGoalState ( const moveit::core::RobotState goal)

Definition at line 957 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ setQueryStartState()

void moveit_rviz_plugin::MotionPlanningDisplay::setQueryStartState ( const moveit::core::RobotState start)

Definition at line 951 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ setQueryStateHelper()

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

Definition at line 1080 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ setStatusTextColor()

void moveit_rviz_plugin::MotionPlanningDisplay::setStatusTextColor ( const QColor &  color)

Definition at line 687 of file motion_planning_display.cpp.

Here is the caller graph for this function:

◆ toggleSelectPlanningGroupSubscription()

void moveit_rviz_plugin::MotionPlanningDisplay::toggleSelectPlanningGroupSubscription ( bool  enable)

Definition at line 278 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ update()

void moveit_rviz_plugin::MotionPlanningDisplay::update ( float  wall_dt,
float  ros_dt 
)
override

Definition at line 1338 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ updateBackgroundJobProgressBar()

void moveit_rviz_plugin::MotionPlanningDisplay::updateBackgroundJobProgressBar ( )
protected

Definition at line 326 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ updateInternal()

void moveit_rviz_plugin::MotionPlanningDisplay::updateInternal ( double  wall_dt,
double  ros_dt 
)
overrideprotectedvirtual

Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.

Definition at line 1348 of file motion_planning_display.cpp.

Here is the call graph for this function:

◆ updateLinkColors()

void moveit_rviz_plugin::MotionPlanningDisplay::updateLinkColors ( )
protected

Definition at line 990 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ updateQueryGoalState()

void moveit_rviz_plugin::MotionPlanningDisplay::updateQueryGoalState ( )

Definition at line 938 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ updateQueryStartState()

void moveit_rviz_plugin::MotionPlanningDisplay::updateQueryStartState ( )

Definition at line 930 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ updateQueryStates()

void moveit_rviz_plugin::MotionPlanningDisplay::updateQueryStates ( const moveit::core::RobotState current_state)

Definition at line 1265 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ updateStateExceptModified()

void moveit_rviz_plugin::MotionPlanningDisplay::updateStateExceptModified ( moveit::core::RobotState dest,
const moveit::core::RobotState src 
)
protected

Definition at line 1246 of file motion_planning_display.cpp.

Here is the call graph for this function:
Here is the caller graph for this function:

◆ useApproximateIK()

void moveit_rviz_plugin::MotionPlanningDisplay::useApproximateIK ( bool  flag)

Definition at line 963 of file motion_planning_display.cpp.

◆ visualizePlaceLocations()

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

Definition at line 1473 of file motion_planning_display.cpp.

Here is the call graph for this function:

Member Data Documentation

◆ compute_weight_limit_property_

rviz_common::properties::BoolProperty* moveit_rviz_plugin::MotionPlanningDisplay::compute_weight_limit_property_
protected

Definition at line 318 of file motion_planning_display.h.

◆ computed_metrics_

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 290 of file motion_planning_display.h.

◆ dynamics_solver_

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

Definition at line 296 of file motion_planning_display.h.

◆ frame_

MotionPlanningFrame* moveit_rviz_plugin::MotionPlanningDisplay::frame_
protected

Definition at line 270 of file motion_planning_display.h.

◆ frame_dock_

rviz_common::PanelDockWidget* moveit_rviz_plugin::MotionPlanningDisplay::frame_dock_
protected

Definition at line 271 of file motion_planning_display.h.

◆ int_marker_display_

rviz_common::Display* moveit_rviz_plugin::MotionPlanningDisplay::int_marker_display_
protected

Definition at line 326 of file motion_planning_display.h.

◆ kinematics_metrics_

kinematics_metrics::KinematicsMetricsPtr moveit_rviz_plugin::MotionPlanningDisplay::kinematics_metrics_
protected

Definition at line 295 of file motion_planning_display.h.

◆ menu_handler_goal_

std::shared_ptr<interactive_markers::MenuHandler> moveit_rviz_plugin::MotionPlanningDisplay::menu_handler_goal_
protected

Definition at line 278 of file motion_planning_display.h.

◆ menu_handler_start_

std::shared_ptr<interactive_markers::MenuHandler> moveit_rviz_plugin::MotionPlanningDisplay::menu_handler_start_
protected

Definition at line 277 of file motion_planning_display.h.

◆ metrics_category_

rviz_common::properties::Property* moveit_rviz_plugin::MotionPlanningDisplay::metrics_category_
protected

Definition at line 305 of file motion_planning_display.h.

◆ metrics_set_payload_property_

rviz_common::properties::FloatProperty* moveit_rviz_plugin::MotionPlanningDisplay::metrics_set_payload_property_
protected

Definition at line 322 of file motion_planning_display.h.

◆ metrics_text_height_property_

rviz_common::properties::FloatProperty* moveit_rviz_plugin::MotionPlanningDisplay::metrics_text_height_property_
protected

Definition at line 323 of file motion_planning_display.h.

◆ modified_groups_

std::set<std::string> moveit_rviz_plugin::MotionPlanningDisplay::modified_groups_
protected

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 286 of file motion_planning_display.h.

◆ path_category_

rviz_common::properties::Property* moveit_rviz_plugin::MotionPlanningDisplay::path_category_
protected

Definition at line 303 of file motion_planning_display.h.

◆ place_locations_display_

std::vector<std::shared_ptr<rviz_rendering::Shape> > moveit_rviz_plugin::MotionPlanningDisplay::place_locations_display_

Definition at line 160 of file motion_planning_display.h.

◆ plan_category_

rviz_common::properties::Property* moveit_rviz_plugin::MotionPlanningDisplay::plan_category_
protected

Definition at line 304 of file motion_planning_display.h.

◆ planning_group_property_

rviz_common::properties::EditableEnumProperty* moveit_rviz_plugin::MotionPlanningDisplay::planning_group_property_
protected

Definition at line 307 of file motion_planning_display.h.

◆ planning_group_sub_

rclcpp::Subscription<std_msgs::msg::String>::SharedPtr moveit_rviz_plugin::MotionPlanningDisplay::planning_group_sub_
protected

Definition at line 264 of file motion_planning_display.h.

◆ position_only_ik_

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 292 of file motion_planning_display.h.

◆ previous_state_

moveit::core::RobotStatePtr moveit_rviz_plugin::MotionPlanningDisplay::previous_state_
protected

remember previous start state (updated before starting execution)

Definition at line 282 of file motion_planning_display.h.

◆ query_colliding_link_color_property_

rviz_common::properties::ColorProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_colliding_link_color_property_
protected

Definition at line 315 of file motion_planning_display.h.

◆ query_goal_alpha_property_

rviz_common::properties::FloatProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_goal_alpha_property_
protected

Definition at line 314 of file motion_planning_display.h.

◆ query_goal_color_property_

rviz_common::properties::ColorProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_goal_color_property_
protected

Definition at line 312 of file motion_planning_display.h.

◆ query_goal_state_

robot_interaction::InteractionHandlerPtr moveit_rviz_plugin::MotionPlanningDisplay::query_goal_state_
protected

Definition at line 276 of file motion_planning_display.h.

◆ query_goal_state_property_

rviz_common::properties::BoolProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_goal_state_property_
protected

Definition at line 309 of file motion_planning_display.h.

◆ query_marker_scale_property_

rviz_common::properties::FloatProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_marker_scale_property_
protected

Definition at line 310 of file motion_planning_display.h.

◆ query_outside_joint_limits_link_color_property_

rviz_common::properties::ColorProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_outside_joint_limits_link_color_property_
protected

Definition at line 316 of file motion_planning_display.h.

◆ query_robot_goal_

RobotStateVisualizationPtr moveit_rviz_plugin::MotionPlanningDisplay::query_robot_goal_
protected

Handles drawing the robot at the goal configuration.

Definition at line 258 of file motion_planning_display.h.

◆ query_robot_start_

RobotStateVisualizationPtr moveit_rviz_plugin::MotionPlanningDisplay::query_robot_start_
protected

Handles drawing the robot at the start configuration.

Definition at line 257 of file motion_planning_display.h.

◆ query_start_alpha_property_

rviz_common::properties::FloatProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_start_alpha_property_
protected

Definition at line 313 of file motion_planning_display.h.

◆ query_start_color_property_

rviz_common::properties::ColorProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_start_color_property_
protected

Definition at line 311 of file motion_planning_display.h.

◆ query_start_state_

robot_interaction::InteractionHandlerPtr moveit_rviz_plugin::MotionPlanningDisplay::query_start_state_
protected

Definition at line 275 of file motion_planning_display.h.

◆ query_start_state_property_

rviz_common::properties::BoolProperty* moveit_rviz_plugin::MotionPlanningDisplay::query_start_state_property_
protected

Definition at line 308 of file motion_planning_display.h.

◆ robot_interaction_

robot_interaction::RobotInteractionPtr moveit_rviz_plugin::MotionPlanningDisplay::robot_interaction_
protected

Definition at line 274 of file motion_planning_display.h.

◆ show_joint_torques_property_

rviz_common::properties::BoolProperty* moveit_rviz_plugin::MotionPlanningDisplay::show_joint_torques_property_
protected

Definition at line 321 of file motion_planning_display.h.

◆ show_manipulability_index_property_

rviz_common::properties::BoolProperty* moveit_rviz_plugin::MotionPlanningDisplay::show_manipulability_index_property_
protected

Definition at line 319 of file motion_planning_display.h.

◆ show_manipulability_property_

rviz_common::properties::BoolProperty* moveit_rviz_plugin::MotionPlanningDisplay::show_manipulability_property_
protected

Definition at line 320 of file motion_planning_display.h.

◆ show_workspace_property_

rviz_common::properties::BoolProperty* moveit_rviz_plugin::MotionPlanningDisplay::show_workspace_property_
protected

Definition at line 324 of file motion_planning_display.h.

◆ status_links_goal_

std::map<std::string, LinkDisplayStatus> moveit_rviz_plugin::MotionPlanningDisplay::status_links_goal_
protected

Definition at line 280 of file motion_planning_display.h.

◆ status_links_start_

std::map<std::string, LinkDisplayStatus> moveit_rviz_plugin::MotionPlanningDisplay::status_links_start_
protected

Definition at line 279 of file motion_planning_display.h.

◆ text_display_for_start_

bool moveit_rviz_plugin::MotionPlanningDisplay::text_display_for_start_
protected

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

Definition at line 261 of file motion_planning_display.h.

◆ text_display_scene_node_

Ogre::SceneNode* moveit_rviz_plugin::MotionPlanningDisplay::text_display_scene_node_
protected

displays texts

Definition at line 260 of file motion_planning_display.h.

◆ text_to_display_

rviz_rendering::MovableText* moveit_rviz_plugin::MotionPlanningDisplay::text_to_display_
protected

Definition at line 262 of file motion_planning_display.h.

◆ trajectory_visual_

TrajectoryVisualizationPtr moveit_rviz_plugin::MotionPlanningDisplay::trajectory_visual_
protected

Definition at line 300 of file motion_planning_display.h.

◆ update_metrics_lock_

std::mutex moveit_rviz_plugin::MotionPlanningDisplay::update_metrics_lock_
protected

Definition at line 297 of file motion_planning_display.h.

◆ workspace_box_

std::unique_ptr<rviz_rendering::Shape> moveit_rviz_plugin::MotionPlanningDisplay::workspace_box_
protected

Definition at line 267 of file motion_planning_display.h.


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