33 double color_step_size = 240.0 / (record->tracks.size() + 1);
36 std::vector<ISM::PosePtr> track_poses;
39 std::string marker_namespace;
40 for (
size_t i = 0; i < record->tracks.size(); i++)
44 marker_namespace = this->
prefix_ + record->tracks[i]->type +
"_" + record->tracks[i]->observedId +
"_track";
47 return_markers.markers.insert(return_markers.markers.end(), temp_markers.markers.begin(), temp_markers.markers.end());
50 return return_markers;
void publishCollectedMarkers()
static ColorRGBA hsvToRGBA(double hue, double saturation, double value)
static MarkerArray createTrackMarkers(std::vector< ISM::PosePtr > trackPoses, std::string baseFrame, std::string markerNamespace, float lineWidth, ColorRGBA color, double markerLifetime)
std_msgs::ColorRGBA ColorRGBA
visualization_msgs::MarkerArray MarkerArray
void addMarker(visualization_msgs::Marker marker)
void addVisualization(const ISM::TracksPtr record)
visualization_msgs::MarkerArray generateRecordMarkers(const ISM::TracksPtr record)
static std::vector< ISM::PosePtr > posesFromTrack(ISM::TrackPtr track)