|
@@ -12,12 +12,13 @@
|
|
|
vtd_autoware::vtd_autoware()
|
|
|
: private_nh_("~")
|
|
|
{
|
|
|
-
|
|
|
+ mpthread = new std::thread(&vtd_autoware::threadobject,this);
|
|
|
}
|
|
|
|
|
|
vtd_autoware::~vtd_autoware()
|
|
|
{
|
|
|
-
|
|
|
+ mbRun = false;
|
|
|
+ mpthread->join();
|
|
|
}
|
|
|
|
|
|
void vtd_autoware::createROSPubSub()
|
|
@@ -31,7 +32,7 @@ void vtd_autoware::ConvertToObjectArray(std::vector<iv::vtd::rdbdata> & xvectorr
|
|
|
int i;
|
|
|
int j;
|
|
|
std::cout<<" obj size: "<<xvectorrdbdata.size()<<std::endl;
|
|
|
- for(i=0;i<(int)xvectorrdbdata.size();i++)
|
|
|
+ for(i=0;i<static_cast<int>(xvectorrdbdata.size());i++)
|
|
|
{
|
|
|
iv::vtd::rdbdata * prdbdata = &xvectorrdbdata[i];
|
|
|
for(j=0;j<prdbdata->mrdbitem_size();j++)
|
|
@@ -150,11 +151,13 @@ void vtd_autoware::threadobject()
|
|
|
autoware_msgs::DetectedObjectArray objects;
|
|
|
// iv::fusion::fusionobjectarray xfusionarray;
|
|
|
// ConvertToObjectArray(xvectorrdbdata,xfusionarray);
|
|
|
+
|
|
|
ConvertToObjectArray(xvectorrdbdata,objects);
|
|
|
|
|
|
pub_objects_.publish(objects);
|
|
|
|
|
|
objects.header.frame_id = "vtd";
|
|
|
+
|
|
|
objects.header.seq = nseq;
|
|
|
// objects.header.stamp = 1;
|
|
|
|