Displays a vision_msgs::CopAnswer message. More...
#include <CopAnswerDisplay.h>
Public Member Functions | |
CopAnswerDisplay (const std::string &name, rviz::VisualizationManager *manager) | |
virtual void | createProperties () |
float | getA () |
bool | getAuto () |
float | getB () |
float | getD () |
bool | getHand () |
float | getOffset () |
float | getOfftop () |
bool | getSGP () |
rviz::Color | getSGPColor () |
float | getTH () |
void | setA (float showGrapsPlanner) |
void | setAuto (bool rightHand) |
void | setB (float showGrapsPlanner) |
void | setD (float showGrapsPlanner) |
void | setHand (bool rightHand) |
void | setOffset (float offset) |
void | setOfftop (float offset) |
void | setSGP (bool showGrapsPlanner) |
void | setSGPColor (rviz::Color color) |
void | setTH (float showGrapsPlanner) |
virtual void | setTopic (const std::string &topic) |
virtual | ~CopAnswerDisplay () |
Protected Member Functions | |
void | AttachSGPPoints (Ogre::SceneNode *object, std::vector< vision_msgs::partial_lo::_pose_type > matrices, std::vector< vision_msgs::partial_lo::_cov_type > covs, size_t index) |
double | GetOffsetBaseLinkRotZ (Ogre::Quaternion quat) |
void | incomingMessage (const vision_msgs::cop_answerConstPtr &msg) |
void | processMessage (vision_msgs::cop_answer &msg) |
void | processMessage () |
void | subscribe () |
void | unsubscribe () |
Protected Attributes | |
float | alpha |
float | beta |
ros::Subscriber | cop_subscriber |
float | delta |
rviz::FloatPropertyWPtr | m_alpha_prop |
bool | m_auto |
rviz::BoolPropertyWPtr | m_auto_prop |
rviz::FloatPropertyWPtr | m_beta_prop |
vision_msgs::cop_answer | m_currentMessage |
rviz::FloatPropertyWPtr | m_delta_prop |
bool | m_hand |
rviz::BoolPropertyWPtr | m_hand_property |
HandConfig | m_manConf |
float | m_offset |
rviz::FloatPropertyWPtr | m_offset_property |
float | m_offtop |
rviz::FloatPropertyWPtr | m_offtop_property |
bool | m_sgp |
rviz::BoolPropertyWPtr | m_sgp_property |
rviz::Color | m_sgpColor |
rviz::ColorPropertyWPtr | m_sgpColor_prop |
float | m_th |
rviz::FloatPropertyWPtr | m_th_property |
Displays a vision_msgs::CopAnswer message.
Definition at line 44 of file CopAnswerDisplay.h.
rviz_shows_cop::CopAnswerDisplay::CopAnswerDisplay | ( | const std::string & | name, |
rviz::VisualizationManager * | manager | ||
) |
Definition at line 49 of file CopAnswerDisplay.cpp.
rviz_shows_cop::CopAnswerDisplay::~CopAnswerDisplay | ( | ) | [virtual] |
Definition at line 62 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::AttachSGPPoints | ( | Ogre::SceneNode * | object, |
std::vector< vision_msgs::partial_lo::_pose_type > | matrices, | ||
std::vector< vision_msgs::partial_lo::_cov_type > | covs, | ||
size_t | index | ||
) | [protected] |
this does not make sense for an empty list
Init hardcoded hand points
Init target and obstacles (target at index in the incoming list must be a position 0 of the obstacles)
Call initialization of SGP always for multi-instance support, actually we would need a mutex here, TODO
Call SGP
Visualize results
Definition at line 178 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::createProperties | ( | ) | [virtual] |
Reimplemented from rviz_shows_cop::JloDisplayBase.
Definition at line 446 of file CopAnswerDisplay.cpp.
float rviz_shows_cop::CopAnswerDisplay::getA | ( | ) | [inline] |
Definition at line 86 of file CopAnswerDisplay.h.
bool rviz_shows_cop::CopAnswerDisplay::getAuto | ( | ) | [inline] |
Definition at line 101 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::getB | ( | ) | [inline] |
Definition at line 91 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::getD | ( | ) | [inline] |
Definition at line 96 of file CopAnswerDisplay.h.
bool rviz_shows_cop::CopAnswerDisplay::getHand | ( | ) | [inline] |
Definition at line 59 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::getOffset | ( | ) | [inline] |
Definition at line 75 of file CopAnswerDisplay.h.
double rviz_shows_cop::CopAnswerDisplay::GetOffsetBaseLinkRotZ | ( | Ogre::Quaternion | quat | ) | [protected] |
TODO: get object to baselink rotation
Definition at line 168 of file CopAnswerDisplay.cpp.
float rviz_shows_cop::CopAnswerDisplay::getOfftop | ( | ) | [inline] |
Definition at line 80 of file CopAnswerDisplay.h.
bool rviz_shows_cop::CopAnswerDisplay::getSGP | ( | ) | [inline] |
Definition at line 54 of file CopAnswerDisplay.h.
rviz::Color rviz_shows_cop::CopAnswerDisplay::getSGPColor | ( | ) | [inline] |
Definition at line 64 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::getTH | ( | ) | [inline] |
Definition at line 69 of file CopAnswerDisplay.h.
void rviz_shows_cop::CopAnswerDisplay::incomingMessage | ( | const vision_msgs::cop_answerConstPtr & | msg | ) | [protected] |
Definition at line 431 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::processMessage | ( | vision_msgs::cop_answer & | msg | ) | [protected] |
Definition at line 384 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::processMessage | ( | ) | [inline, protected, virtual] |
Implements rviz_shows_cop::JloDisplayBase.
Definition at line 113 of file CopAnswerDisplay.h.
void rviz_shows_cop::CopAnswerDisplay::setA | ( | float | showGrapsPlanner | ) |
Definition at line 127 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setAuto | ( | bool | rightHand | ) |
Definition at line 92 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setB | ( | float | showGrapsPlanner | ) |
Definition at line 134 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setD | ( | float | showGrapsPlanner | ) |
Definition at line 141 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setHand | ( | bool | rightHand | ) |
Definition at line 85 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setOffset | ( | float | offset | ) |
Definition at line 114 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setOfftop | ( | float | offset | ) |
Definition at line 120 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setSGP | ( | bool | showGrapsPlanner | ) |
Definition at line 78 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setSGPColor | ( | rviz::Color | color | ) |
Definition at line 100 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setTH | ( | float | showGrapsPlanner | ) |
Definition at line 107 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::setTopic | ( | const std::string & | topic | ) | [virtual] |
Reimplemented from rviz_shows_cop::JloDisplayBase.
Definition at line 69 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::subscribe | ( | ) | [protected] |
Definition at line 150 of file CopAnswerDisplay.cpp.
void rviz_shows_cop::CopAnswerDisplay::unsubscribe | ( | ) | [protected] |
Definition at line 162 of file CopAnswerDisplay.cpp.
float rviz_shows_cop::CopAnswerDisplay::alpha [protected] |
Definition at line 130 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::beta [protected] |
Definition at line 131 of file CopAnswerDisplay.h.
Definition at line 113 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::delta [protected] |
Definition at line 132 of file CopAnswerDisplay.h.
rviz::FloatPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_alpha_prop [protected] |
Definition at line 143 of file CopAnswerDisplay.h.
bool rviz_shows_cop::CopAnswerDisplay::m_auto [protected] |
Definition at line 124 of file CopAnswerDisplay.h.
rviz::BoolPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_auto_prop [protected] |
Definition at line 142 of file CopAnswerDisplay.h.
rviz::FloatPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_beta_prop [protected] |
Definition at line 144 of file CopAnswerDisplay.h.
vision_msgs::cop_answer rviz_shows_cop::CopAnswerDisplay::m_currentMessage [protected] |
Definition at line 140 of file CopAnswerDisplay.h.
rviz::FloatPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_delta_prop [protected] |
Definition at line 145 of file CopAnswerDisplay.h.
bool rviz_shows_cop::CopAnswerDisplay::m_hand [protected] |
Definition at line 123 of file CopAnswerDisplay.h.
rviz::BoolPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_hand_property [protected] |
Definition at line 135 of file CopAnswerDisplay.h.
Definition at line 129 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::m_offset [protected] |
Definition at line 126 of file CopAnswerDisplay.h.
rviz::FloatPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_offset_property [protected] |
Definition at line 138 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::m_offtop [protected] |
Definition at line 127 of file CopAnswerDisplay.h.
rviz::FloatPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_offtop_property [protected] |
Definition at line 139 of file CopAnswerDisplay.h.
bool rviz_shows_cop::CopAnswerDisplay::m_sgp [protected] |
Definition at line 122 of file CopAnswerDisplay.h.
rviz::BoolPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_sgp_property [protected] |
Definition at line 134 of file CopAnswerDisplay.h.
Definition at line 128 of file CopAnswerDisplay.h.
rviz::ColorPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_sgpColor_prop [protected] |
Definition at line 136 of file CopAnswerDisplay.h.
float rviz_shows_cop::CopAnswerDisplay::m_th [protected] |
Definition at line 125 of file CopAnswerDisplay.h.
rviz::FloatPropertyWPtr rviz_shows_cop::CopAnswerDisplay::m_th_property [protected] |
Definition at line 137 of file CopAnswerDisplay.h.