40 #include <std_msgs/Header.h>
41 #include <tf/transform_listener.h>
42 #include "mtt/TargetList.h"
44 #include <visualization_msgs/Marker.h>
45 #include <visualization_msgs/MarkerArray.h>
62 for(uint i = 0; i < list.Targets.size(); i++){
73 for(uint i = 0; i < msg.markers.size(); i++){
84 for(uint i = 0; i < msg.markers.size(); i++){
94 int main(
int argc,
char** argv)
96 ros::init(argc, argv,
"bag_filter");
99 ros::Rate loop_rate(10);
101 ros::Subscriber sub_targets = n.subscribe(
"/targetsF", 1000,
targetsCallback);
102 ros::Subscriber sub_arrows = n.subscribe(
"/arrowsF", 1000,
arrowsCallback);
103 ros::Subscriber sub_ids = n.subscribe(
"/idsF", 1000,
idsCallback);
105 targets_pub = n.advertise<mtt::TargetList>(
"/targets", 100);
106 arrows_pub = n.advertise<visualization_msgs::MarkerArray>(
"/arrows", 100);
107 ids_pub = n.advertise<visualization_msgs::MarkerArray>(
"/ids", 100);
ros::Publisher arrows_pub
void idsCallback(const visualization_msgs::MarkerArray &msg)
visualization_msgs::Marker ids_marker
visualization_msgs::MarkerArray arrow_markerList
void targetsCallback(const mtt::TargetList &list)
visualization_msgs::Marker arrow_marker
visualization_msgs::MarkerArray ids_markerList
int main(int argc, char **argv)
void arrowsCallback(const visualization_msgs::MarkerArray &msg)
ros::Publisher targets_pub
mtt::TargetList targetList
Tag good/bad leader in bag files.