-
Notifications
You must be signed in to change notification settings - Fork 3
/
Copy pathgen_pcd.cpp
49 lines (35 loc) · 1.35 KB
/
gen_pcd.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
#include <iostream>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <boost/lexical_cast.hpp>
// based on http://pointclouds.org/documentation/tutorials/writing_pcd.php#writing-pcd
pcl::PointCloud<pcl::PointXYZ>::Ptr
createRandomCloud(int width, int height)
{
pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);
cloud->width = width;
cloud->height = height;
cloud->is_dense = false;
cloud->points.resize (cloud->width * cloud->height);
for (size_t i = 0; i < cloud->points.size (); ++i)
{
cloud->points[i].x = 1024 * rand () / (RAND_MAX + 1.0f);
cloud->points[i].y = 1024 * rand () / (RAND_MAX + 1.0f);
cloud->points[i].z = 1024 * rand () / (RAND_MAX + 1.0f);
}
return cloud;
}
int
main (int argc, char** argv)
{
int n = 1;
for(int i=0; i<7; i++) {
pcl::PointCloud<pcl::PointXYZ>::Ptr cloud = createRandomCloud(n, 10);
pcl::io::savePCDFileASCII ("test_pcd_" + boost::lexical_cast<std::string>(n*10) + ".pcd", *cloud);
std::cerr << "Saved " << cloud->points.size () << " data points to test_pcd_" << boost::lexical_cast<std::string>(n*10) << ".pcd" << std::endl;
// for (size_t i = 0; i < cloud->points.size (); ++i)
// std::cerr << " " << cloud->points[i].x << " " << cloud->points[i].y << " " << cloud->points[i].z << std::endl;
n *= 10;
}
return (0);
}