#include <motion_planning_display.h>
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 Member Functions inherited from moveit_rviz_plugin::PlanningSceneDisplay | |
void | addBackgroundJob (const boost::function< void()> &job, const std::string &name) |
void | addMainLoopJob (const boost::function< void()> &job) |
queue the execution of this function for the next time the main update() loop gets called More... | |
void | clearJobs () |
remove all queued jobs More... | |
const std::string | getMoveGroupNS () const |
const planning_scene_monitor::PlanningSceneMonitorPtr & | getPlanningSceneMonitor () |
planning_scene_monitor::LockedPlanningSceneRO | getPlanningSceneRO () const |
get read-only access to planning scene More... | |
planning_scene_monitor::LockedPlanningSceneRW | getPlanningSceneRW () |
get write access to planning scene More... | |
const robot_model::RobotModelConstPtr & | getRobotModel () const |
PlanningSceneDisplay (bool listen_to_planning_scene=true, bool show_scene_robot=true) | |
void | queueRenderSceneGeometry () |
void | setLinkColor (const std::string &link_name, const QColor &color) |
void | spawnBackgroundJob (const boost::function< void()> &job) |
void | unsetLinkColor (const std::string &link_name) |
void | waitForAllMainLoopJobs () |
bool | waitForCurrentRobotState (const ros::Time &t=ros::Time::now()) |
wait for robot state more recent than t More... | |
virtual | ~PlanningSceneDisplay () |
Public Member Functions inherited from rviz::Display | |
virtual void | deleteStatus (const QString &name) |
void | deleteStatusStd (const std::string &name) |
Display () | |
void | emitTimeSignal (ros::Time time) |
QWidget * | getAssociatedWidget () const |
PanelDockWidget * | getAssociatedWidgetPanel () |
virtual QString | getClassId () const |
Ogre::SceneNode * | getSceneNode () const |
virtual QVariant | getViewData (int column, int role) const |
virtual Qt::ItemFlags | getViewFlags (int column) const |
uint32_t | getVisibilityBits () |
void | initialize (DisplayContext *context) |
bool | isEnabled () const |
void | setAssociatedWidget (QWidget *widget) |
virtual void | setClassId (const QString &class_id) |
void | setFixedFrame (const QString &fixed_frame) |
virtual void | setStatus (StatusProperty::Level level, const QString &name, const QString &text) |
void | setStatusStd (StatusProperty::Level level, const std::string &name, const std::string &text) |
virtual void | setTopic (const QString &topic, const QString &datatype) |
void | setVisibilityBits (uint32_t bits) |
void | unsetVisibilityBits (uint32_t bits) |
virtual | ~Display () |
Public Member Functions inherited from rviz::BoolProperty | |
BoolProperty (const QString &name=QString(), bool default_value=false, const QString &description=QString(), Property *parent=0, const char *changed_slot=0, QObject *receiver=0) | |
virtual bool | getBool () const |
virtual bool | getDisableChildren () |
bool | getDisableChildrenIfFalse () |
void | setDisableChildrenIfFalse (bool disable) |
virtual | ~BoolProperty () |
Public Member Functions inherited from rviz::Property | |
virtual void | addChild (Property *child, int index=-1) |
Property * | childAt (int index) const |
virtual Property * | childAtUnchecked (int index) const |
virtual void | collapse () |
bool | contains (Property *possible_child) const |
virtual QWidget * | createEditor (QWidget *parent, const QStyleOptionViewItem &option) |
virtual void | expand () |
virtual QString | getDescription () const |
virtual bool | getHidden () const |
virtual QIcon | getIcon () const |
PropertyTreeModel * | getModel () const |
virtual QString | getName () const |
std::string | getNameStd () const |
Property * | getParent () const |
virtual bool | getReadOnly () |
virtual QVariant | getValue () const |
void | hide () |
bool | isAncestorOf (Property *possible_child) const |
virtual void | moveChild (int from_index, int to_index) |
virtual int | numChildren () const |
virtual bool | paint (QPainter *painter, const QStyleOptionViewItem &option) const |
Property (const QString &name=QString(), const QVariant default_value=QVariant(), const QString &description=QString(), Property *parent=0, const char *changed_slot=0, QObject *receiver=0) | |
virtual void | removeChildren (int start_index=0, int count=-1) |
int | rowNumberInParent () const |
virtual void | setDescription (const QString &description) |
virtual void | setHidden (bool hidden) |
virtual void | setIcon (const QIcon &icon) |
void | setModel (PropertyTreeModel *model) |
void | setParent (Property *new_parent) |
virtual void | setReadOnly (bool read_only) |
void | setShouldBeSaved (bool save) |
virtual bool | setValue (const QVariant &new_value) |
bool | shouldBeSaved () const |
void | show () |
virtual Property * | subProp (const QString &sub_name) |
Property * | takeChild (Property *child) |
virtual Property * | takeChildAt (int index) |
virtual | ~Property () |
Public Attributes | |
std::vector< std::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. More... | |
virtual void | onSceneMonitorReceivedUpdate (planning_scene_monitor::PlanningSceneMonitor::SceneUpdateType update_type) |
void | populateMenuHandler (std::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 Member Functions inherited from moveit_rviz_plugin::PlanningSceneDisplay | |
void | calculateOffsetPosition () |
Set the scene node's position, given the target frame and the planning frame. More... | |
void | clearRobotModel () |
virtual planning_scene_monitor::PlanningSceneMonitorPtr | createPlanningSceneMonitor () |
void | executeMainLoopJobs () |
void | loadRobotModel () |
void | renderPlanningScene () |
void | sceneMonitorReceivedUpdate (planning_scene_monitor::PlanningSceneMonitor::SceneUpdateType update_type) |
void | setGroupColor (rviz::Robot *robot, const std::string &group_name, const QColor &color) |
void | setLinkColor (rviz::Robot *robot, const std::string &link_name, const QColor &color) |
void | unsetAllColors (rviz::Robot *robot) |
void | unsetGroupColor (rviz::Robot *robot, const std::string &group_name) |
void | unsetLinkColor (rviz::Robot *robot, const std::string &link_name) |
Protected Member Functions inherited from rviz::Display | |
virtual void | clearStatuses () |
bool | initialized () const |
Protected Member Functions inherited from rviz::Property | |
void | loadValue (const Config &config) |
Private Slots | |
void | changedAttachedBodyColor () override |
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 () |
Additional Inherited Members | |
Public Slots inherited from rviz::Display | |
virtual void | onEnableChanged () |
void | queueRender () |
void | setEnabled (bool enabled) |
virtual void | setIcon (const QIcon &icon) |
Public Slots inherited from rviz::BoolProperty | |
bool | setBool (bool value) |
Signals inherited from rviz::Display | |
void | timeSignal (rviz::Display *display, ros::Time time) |
Signals inherited from rviz::Property | |
void | aboutToChange () |
void | changed () |
void | childListChanged (Property *this_property) |
Protected Slots inherited from moveit_rviz_plugin::PlanningSceneDisplay | |
virtual void | changedAttachedBodyColor () |
Definition at line 84 of file motion_planning_display.h.
|
protected |
Enumerator | |
---|---|
COLLISION_LINK | |
OUTSIDE_BOUNDS_LINK |
Definition at line 183 of file motion_planning_display.h.
moveit_rviz_plugin::MotionPlanningDisplay::MotionPlanningDisplay | ( | ) |
Definition at line 81 of file motion_planning_display.cpp.
|
virtual |
Definition at line 180 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::addStatusText | ( | const std::string & | text | ) |
Definition at line 691 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::addStatusText | ( | const std::vector< std::string > & | text | ) |
Definition at line 697 of file motion_planning_display.cpp.
|
protected |
Definition at line 323 of file motion_planning_display.cpp.
|
overrideprivateslot |
Definition at line 901 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 419 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 433 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 1032 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 889 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 883 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 871 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 728 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 895 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 859 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 853 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 841 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 717 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 405 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 391 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 377 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 363 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 1058 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::changePlanningGroup | ( | const std::string & | group | ) |
Definition at line 1018 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::clearPlaceLocationsDisplay | ( | ) |
Definition at line 1425 of file motion_planning_display.cpp.
|
protected |
Definition at line 483 of file motion_planning_display.cpp.
|
protected |
Definition at line 499 of file motion_planning_display.cpp.
|
protected |
Definition at line 559 of file motion_planning_display.cpp.
|
protected |
Definition at line 438 of file motion_planning_display.cpp.
|
protected |
Definition at line 739 of file motion_planning_display.cpp.
|
protected |
Definition at line 617 of file motion_planning_display.cpp.
|
inline |
Definition at line 126 of file motion_planning_display.h.
|
protected |
|
protectedvirtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1416 of file motion_planning_display.cpp.
std::string moveit_rviz_plugin::MotionPlanningDisplay::getCurrentPlanningGroup | ( | ) | const |
Definition at line 1063 of file motion_planning_display.cpp.
|
inline |
Definition at line 106 of file motion_planning_display.h.
|
inline |
Definition at line 121 of file motion_planning_display.h.
|
inline |
Definition at line 101 of file motion_planning_display.h.
|
inline |
Definition at line 116 of file motion_planning_display.h.
|
inline |
Definition at line 111 of file motion_planning_display.h.
|
protected |
Definition at line 975 of file motion_planning_display.cpp.
|
virtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1303 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 260 of file motion_planning_display.cpp.
|
protectedvirtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1261 of file motion_planning_display.cpp.
|
protectedvirtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1239 of file motion_planning_display.cpp.
|
protectedvirtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 194 of file motion_planning_display.cpp.
|
protectedvirtual |
This is an event called by loadRobotModel() in the MainLoop; do not call directly.
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1135 of file motion_planning_display.cpp.
|
protectedvirtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1211 of file motion_planning_display.cpp.
|
protected |
Definition at line 1103 of file motion_planning_display.cpp.
|
protected |
Definition at line 812 of file motion_planning_display.cpp.
|
protected |
Definition at line 710 of file motion_planning_display.cpp.
|
protected |
Definition at line 703 of file motion_planning_display.cpp.
|
protected |
Definition at line 461 of file motion_planning_display.cpp.
|
virtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 293 of file motion_planning_display.cpp.
|
privateslot |
Definition at line 804 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::resetStatusTextColor | ( | ) |
Definition at line 680 of file motion_planning_display.cpp.
|
virtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1382 of file motion_planning_display.cpp.
|
protected |
Definition at line 921 of file motion_planning_display.cpp.
|
protected |
Definition at line 909 of file motion_planning_display.cpp.
|
protected |
Definition at line 279 of file motion_planning_display.cpp.
|
virtual |
Reimplemented from rviz::Display.
Definition at line 312 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::setQueryGoalState | ( | const robot_state::RobotState & | goal | ) |
Definition at line 953 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::setQueryStartState | ( | const robot_state::RobotState & | start | ) |
Definition at line 947 of file motion_planning_display.cpp.
|
protected |
Definition at line 1068 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::setStatusTextColor | ( | const QColor & | color | ) |
Definition at line 685 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::toggleSelectPlanningGroupSubscription | ( | bool | enable | ) |
Definition at line 266 of file motion_planning_display.cpp.
|
virtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1283 of file motion_planning_display.cpp.
|
protected |
Definition at line 328 of file motion_planning_display.cpp.
|
protectedvirtual |
Reimplemented from moveit_rviz_plugin::PlanningSceneDisplay.
Definition at line 1293 of file motion_planning_display.cpp.
|
protected |
Definition at line 990 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::updateQueryGoalState | ( | ) |
Definition at line 940 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::updateQueryStartState | ( | ) |
Definition at line 933 of file motion_planning_display.cpp.
|
protected |
Definition at line 1193 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::useApproximateIK | ( | bool | flag | ) |
Definition at line 959 of file motion_planning_display.cpp.
void moveit_rviz_plugin::MotionPlanningDisplay::visualizePlaceLocations | ( | const std::vector< geometry_msgs::PoseStamped > & | place_poses | ) |
Definition at line 1432 of file motion_planning_display.cpp.
|
protected |
Definition at line 294 of file motion_planning_display.h.
|
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 266 of file motion_planning_display.h.
|
protected |
Definition at line 272 of file motion_planning_display.h.
|
protected |
Definition at line 248 of file motion_planning_display.h.
|
protected |
Definition at line 249 of file motion_planning_display.h.
|
protected |
Definition at line 302 of file motion_planning_display.h.
|
protected |
Definition at line 271 of file motion_planning_display.h.
|
protected |
Definition at line 256 of file motion_planning_display.h.
|
protected |
Definition at line 255 of file motion_planning_display.h.
|
protected |
Definition at line 281 of file motion_planning_display.h.
|
protected |
Definition at line 298 of file motion_planning_display.h.
|
protected |
Definition at line 299 of file motion_planning_display.h.
|
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 262 of file motion_planning_display.h.
|
protected |
Definition at line 242 of file motion_planning_display.h.
|
protected |
Definition at line 279 of file motion_planning_display.h.
std::vector<std::shared_ptr<rviz::Shape> > moveit_rviz_plugin::MotionPlanningDisplay::place_locations_display_ |
Definition at line 142 of file motion_planning_display.h.
|
protected |
Definition at line 280 of file motion_planning_display.h.
|
protected |
Definition at line 283 of file motion_planning_display.h.
|
protected |
Definition at line 241 of file motion_planning_display.h.
|
protected |
Some groups use position only ik, calls to the metrics have to be modified appropriately.
Definition at line 268 of file motion_planning_display.h.
|
protected |
Definition at line 242 of file motion_planning_display.h.
|
protected |
Definition at line 291 of file motion_planning_display.h.
|
protected |
Definition at line 290 of file motion_planning_display.h.
|
protected |
Definition at line 288 of file motion_planning_display.h.
|
protected |
Definition at line 254 of file motion_planning_display.h.
|
protected |
Definition at line 285 of file motion_planning_display.h.
|
protected |
Definition at line 286 of file motion_planning_display.h.
|
protected |
Definition at line 292 of file motion_planning_display.h.
|
protected |
Handles drawing the robot at the goal configuration.
Definition at line 235 of file motion_planning_display.h.
|
protected |
Handles drawing the robot at the start configuration.
Definition at line 234 of file motion_planning_display.h.
|
protected |
Definition at line 289 of file motion_planning_display.h.
|
protected |
Definition at line 287 of file motion_planning_display.h.
|
protected |
Definition at line 253 of file motion_planning_display.h.
|
protected |
Definition at line 284 of file motion_planning_display.h.
|
protected |
Definition at line 252 of file motion_planning_display.h.
|
protected |
Definition at line 297 of file motion_planning_display.h.
|
protected |
Definition at line 295 of file motion_planning_display.h.
|
protected |
Definition at line 296 of file motion_planning_display.h.
|
protected |
Definition at line 300 of file motion_planning_display.h.
|
protected |
Definition at line 258 of file motion_planning_display.h.
|
protected |
Definition at line 257 of file motion_planning_display.h.
|
protected |
indicates whether the text display is for the start state or not
Definition at line 238 of file motion_planning_display.h.
|
protected |
displays texts
Definition at line 237 of file motion_planning_display.h.
|
protected |
Definition at line 239 of file motion_planning_display.h.
|
protected |
Definition at line 276 of file motion_planning_display.h.
|
protected |
Definition at line 273 of file motion_planning_display.h.
|
protected |
Definition at line 245 of file motion_planning_display.h.