apoorva/greenhouse
2
1
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Adding target_frame

Browse Source 
[Ability to specify frame in bag_to_pcd #55](https://github.com/ros-perception/perception_pcl/issues/55)
This commit is contained in:
Ruffin 2014-10-18 17:59:47 -04:00 committed by Paul Bovbel
parent 155a69e484
commit ac5593dd7c
1 changed files with 15 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
pcl_ros/tools/bag_to_pcd.cpp
View File

@ -66,8 +66,8 @@ int
ros::init (argc, argv, "bag_to_pcd"); ros::init (argc, argv, "bag_to_pcd");
if (argc < 4) if (argc < 4)
{ {
std::cerr << "Syntax is: " << argv[0] << " <file_in.bag> <topic> <output_directory>" << std::endl; std::cerr << "Syntax is: " << argv[0] << " <file_in.bag> <topic> <output_directory> [<target_frame>]" << std::endl;
std::cerr << "Example: " << argv[0] << " data.bag /laser_tilt_cloud ./pointclouds" << std::endl; std::cerr << "Example: " << argv[0] << " data.bag /laser_tilt_cloud ./pointclouds /base_link" << std::endl;
return (-1); return (-1);
} }
@ -132,11 +132,20 @@ int
continue; continue;
} }
// Transform it // If a target_frame was specified
if (!pcl_ros::transformPointCloud ("/base_link", *cloud, cloud_t, tf_listener)) if(argc > 4)
{ {
++view_it; // Transform it
continue; if (!pcl_ros::transformPointCloud (argv[4], *cloud, cloud_t, tf_listener))
{
++view_it;
continue;
}
}
else
{
// Else, don't transform it
cloud_t = *cloud;
} }
std::cerr << "Got " << cloud_t.width * cloud_t.height << " data points in frame " << cloud_t.header.frame_id << " with the following fields: " << pcl::getFieldsList (cloud_t) << std::endl; std::cerr << "Got " << cloud_t.width * cloud_t.height << " data points in frame " << cloud_t.header.frame_id << " with the following fields: " << pcl::getFieldsList (cloud_t) << std::endl;