Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00040 #include <pcl/io/pcd_io.h>
00041 #include <pcl/point_types.h>
00042 #include <mongo_ros/message_collection.h>
00043 #include <semanticmodel/BlobMessage.h>
00044 #include <string>
00045 #include <ros/ros.h>
00046
00047 namespace sm=semanticmodel;
00048 namespace mr=mongo_ros;
00049
00050 using std::string;
00051 using std::cout;
00052
00053 typedef mr::MessageWithMetadata<sm::BlobMessage>::ConstPtr BlobPtr;
00054 typedef pcl::PointXYZRGB Point;
00055 typedef pcl::PointCloud<Point> PointCloud;
00056
00057 int main (int argc, char** argv)
00058 {
00059 ros::init(argc, argv, "download_cloud");
00060 const string filename = "foo.pcd";
00061 if (argc!=3) {
00062 cout << "Usage: download_cloud COLLECTION IND";
00063 exit(1);
00064 }
00065
00066 mongo_ros::MessageCollection<sm::BlobMessage>
00067 blobs("semantic_world_model", argv[1], "bab.willowgarage.com", 27018);
00068
00069 const int n = atoi(argv[2]);
00070
00071 BlobPtr blob = blobs.findOne(mr::Query("id", n));
00072 PointCloud cloud;
00073 pcl::fromROSMsg(blob->points, cloud);
00074 cout << "Got cloud of size " << cloud.points.size();
00075
00076 for (unsigned i=0; i<cloud.points.size(); i++)
00077 {
00078 cloud.points[i].x -= 19.0;
00079 cloud.points[i].y -= 20.0;
00080 }
00081
00082 pcl::io::savePCDFileASCII(filename, cloud);
00083 cout << "Saved cloud to " << filename;
00084
00085 return 0;
00086
00087 }