本文整理汇总了C++中Viewer::addPointCloud方法的典型用法代码示例。如果您正苦于以下问题:C++ Viewer::addPointCloud方法的具体用法?C++ Viewer::addPointCloud怎么用?C++ Viewer::addPointCloud使用的例子?那么恭喜您, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Viewer
的用法示例。
在下文中一共展示了Viewer::addPointCloud方法的2个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: main
/* ******************************************************************************************** */
int main () {
for(int i = 0; i < 4; i++) cs.push_back(Cloud());
pthread_mutex_init(&lock, NULL);
SimpleOpenNIViewer v1(1), v2(2);
v1.init();
v2.init();
// Create the viewer
Viewer* viewer = new Viewer ("3D Viewer");
viewer->setBackgroundColor (0, 0, 0);
viewer->addCoordinateSystem (1.0);
viewer->initCameraParameters ();
viewer->setPointCloudRenderingProperties (pcl::visualization::PCL_VISUALIZER_POINT_SIZE,3,"sample");
// Visualize
while(true) {
Cloud c;
pthread_mutex_lock(&lock);
for(int i = 0; i < 2; i++) {
printf("%d\t", cs[i].size());
c += (cs[i]);
}
printf("\n");
pthread_mutex_unlock(&lock);
viewer->removePointCloud();
Cloud::Ptr cp = c.makeShared();
pcl::visualization::PointCloudColorHandlerRGBField<pcl::PointXYZRGBA> rgb(cp);
viewer->addPointCloud(cp, rgb);
viewer->spinOnce();
// printf("%d\n", c.size());
}
}
示例2: main
//.........这里部分代码省略.........
while(true) {
pthread_mutex_lock(&lock2);
pthread_mutex_unlock(&lock2);
pthread_mutex_lock(&lock);
Cloud::Ptr c (new Cloud);
Cloud::Ptr c1, c2,c3,c4;
c1 = cs[0];
c2 = cs[1];
c3 = cs[2];
c4 = cs[3];
counter++;
// Save the data
if(counter % 10 == 0) {
char buf1 [256];
char buf2 [256];
char buf3 [256];
char buf4 [256];
sprintf(buf1, "kin1-count%04d", counter/4);
sprintf(buf2, "kin2-count%04d", counter/4);
sprintf(buf3, "kin3-count%04d", counter/4);
sprintf(buf4, "kin4-count%04d", counter/4);
pcl::io::savePCDFileASCII (buf1, *c1);
pcl::io::savePCDFileASCII (buf2, *c2);
pcl::io::savePCDFileASCII (buf3, *c3);
pcl::io::savePCDFileASCII (buf4, *c4);
}
double distLimit = 2.5;
printf("seeAll: %d\n", seeAll);
if(seeAll || T == &T1) {
if(counter % 4 == 0) cout << "====== " << counter << " ==============================================\nT1: \n" << T1 << endl;
for (int h=0; h < c1->height; h++) {
for (int w=0; w < c1->width; w++) {
pcl::PointXYZRGBA point = c1->at(w, h);
if(point.x != point.x) continue;
if(point.z > distLimit) continue;
Eigen::Vector4d p (point.x, point.y, point.z, 1);
Eigen::Vector4d Tp = T1 * p;
point.x = Tp(0); point.y = Tp(1); point.z = Tp(2);
c->push_back(point);
}
}
}
if(seeAll || T == &T2) {
if(counter % 4 == 0) cout << "====== " << counter << " ==============================================\nT2: \n" << T2 << endl;
for (int h=0; h < c2->height; h++) {
for (int w=0; w < c2->width; w++) {
pcl::PointXYZRGBA point = c2->at(w, h);
if(point.x != point.x) continue;
if(point.z > distLimit) continue;
Eigen::Vector4d p (point.x, point.y, point.z, 1);
Eigen::Vector4d Tp = T2 * p;
point.x = Tp(0); point.y = Tp(1); point.z = Tp(2);
c->push_back(point);
}
}
}
if(seeAll || T == &T3) {
if(counter % 4 == 0) cout << "====== " << counter << " ==============================================\nT3: \n" << T3 << endl;
for (int h=0; h < c3->height; h++) {
for (int w=0; w < c3->width; w++) {
pcl::PointXYZRGBA point = c3->at(w, h);
if(point.x != point.x) continue;
if(point.z > distLimit) continue;
Eigen::Vector4d p (point.x, point.y, point.z, 1);
Eigen::Vector4d Tp = T3 * p;
point.x = Tp(0); point.y = Tp(1); point.z = Tp(2);
c->push_back(point);
}
}
}
for (int h=0; h < c4->height; h++) {
for (int w=0; w < c4->width; w++) {
pcl::PointXYZRGBA point = c4->at(w, h);
if(point.x != point.x) continue;
if(point.z > distLimit) continue;
Eigen::Vector4d p (point.x, point.y, point.z, 1);
Eigen::Vector4d Tp = T4 * p;
point.x = Tp(0); point.y = Tp(1); point.z = Tp(2);
c->push_back(point);
}
}
// c += c2;
pthread_mutex_unlock(&lock);
viewer->removePointCloud();
pcl::visualization::PointCloudColorHandlerRGBField<pcl::PointXYZRGBA> rgb(c);
viewer->addPointCloud(c, rgb);
viewer->spinOnce();
// printf("%d\n", c.size());
}
}