| 117 | } |
| 118 | |
| 119 | void PlanningVisualization::drawBox(const Eigen::Vector3d& center, const Eigen::Vector3d& scale, |
| 120 | const Eigen::Vector4d& color, const string& ns, const int& id, const int& pub_id) |
| 121 | { |
| 122 | visualization_msgs::Marker mk; |
| 123 | fillBasicInfo(mk, scale, color, ns, id, visualization_msgs::Marker::CUBE); |
| 124 | mk.action = visualization_msgs::Marker::DELETE; |
| 125 | pubs_[pub_id].publish(mk); |
| 126 | |
| 127 | mk.pose.position.x = center[0]; |
| 128 | mk.pose.position.y = center[1]; |
| 129 | mk.pose.position.z = center[2]; |
| 130 | mk.action = visualization_msgs::Marker::ADD; |
| 131 | |
| 132 | pubs_[pub_id].publish(mk); |
| 133 | ros::Duration(0.0005).sleep(); |
| 134 | } |
| 135 | |
| 136 | void PlanningVisualization::drawSpheres(const vector<Eigen::Vector3d>& list, const double& scale, |
| 137 | const Eigen::Vector4d& color, const string& ns, const int& id, const int& pub_id) |
nothing calls this directly
no outgoing calls
no test coverage detected