2

在 Ubuntu 上使用点云库,我试图从 Kinect 中获取多个点云并将它们存储在内存中以供以后在程序中使用。我在这篇文章底部显示的代码旨在存储来自 Kinect 的第一个点云并输出其宽度和高度。该程序给了我一个运行时错误:

/usr/include/boost/smart_ptr/shared_ptr.hpp:418: T* boost::shared_ptr<T>::operator->() const [with T = pcl::PointCloud<pcl::PointXYZ>]: Assertion `px != 0' failed.

非常感谢所有帮助,我总是接受答案!

编码:

  #include <pcl/io/openni_grabber.h>
  #include <pcl/visualization/cloud_viewer.h>

 class SimpleOpenNIViewer
 {
  public:
  SimpleOpenNIViewer () : viewer ("PCL OpenNI Viewer") {}

 pcl::PointCloud<pcl::PointXYZ>::Ptr prevCloud;


  void cloud_cb_ (const pcl::PointCloud<pcl::PointXYZ>::ConstPtr &cloud)
  {


if (!viewer.wasStopped())
   viewer.showCloud (cloud);


//ICP start
if(!prevCloud) {
    pcl::PointCloud<pcl::PointXYZ>::Ptr prevCloud( new pcl::PointCloud<pcl::PointXYZ>());

    pcl::copyPointCloud<pcl::PointXYZ, pcl::PointXYZ>(*cloud, *prevCloud);
}

cout << prevCloud->width << " by " << prevCloud->height << endl; 



  }

  void run ()
  {
    pcl::Grabber* interface = new pcl::OpenNIGrabber();

    boost::function<void (const pcl::PointCloud<pcl::PointXYZ>::ConstPtr&)> f =
      boost::bind (&SimpleOpenNIViewer::cloud_cb_, this, _1);


    interface->registerCallback (f);

    interface->start ();


    while (!viewer.wasStopped())
    {
      boost::this_thread::sleep (boost::posix_time::seconds (1));
    }

    interface->stop ();
  }

  pcl::visualization::CloudViewer viewer;
 };

  int main ()
{
 SimpleOpenNIViewer v;
 v.run ();
 return 0;
}
4

3 回答 3

2

试试这个,我没有安装 Kinect 驱动程序,所以我无法测试。基本上在我的版本中,prevCloud 在构造函数中被实例化,所以(!prevCloud)总是等于'false'。也就是说prevCloud.get() != NULL

#include <pcl/io/openni_grabber.h>
#include <pcl/visualization/cloud_viewer.h>

class SimpleOpenNIViewer
{
typedef pcl::PointXYZ                           Point;
typedef pcl::PointCloud<Point>                  PointCloud;
public:
SimpleOpenNIViewer () : viewer ("PCL OpenNI Viewer") {
        prevCloud = PointCloud::Ptr(NULL);
    }

void cloud_cb_ (const PointCloud::ConstPtr &cloud)
{
    if (!viewer.wasStopped())
        viewer.showCloud (cloud);
            if (!prevCloud) // init previous cloud if first frame
                    prevCloud = PointCloud::Ptr(new PointCloud);
            else.   // else RunICP between cloud and prevCloud
                    //RunICP(cloud,prevCloud);

            //Copy new frame in to prevCloud
    pcl::copyPointCloud<Point, Point>(*cloud, *prevCloud);
    cout << prevCloud->width << " by " << prevCloud->height << endl; 
}

void run ()
{
    pcl::Grabber* interface = new pcl::OpenNIGrabber();

    boost::function<void (const PointCloud::ConstPtr&)> f =
    boost::bind (&SimpleOpenNIViewer::cloud_cb_, this, _1);

    interface->registerCallback (f);
    interface->start ();


    while (!viewer.wasStopped())
    {
        boost::this_thread::sleep (boost::posix_time::seconds (1));
    }

    interface->stop ();
}

PointCloud::Ptr prevCloud;
pcl::visualization::CloudViewer viewer;
};

int main ()
{
SimpleOpenNIViewer v;
v.run ();
return 0;
}
于 2012-07-25T18:07:25.963 回答
0

您正在创建一个新的局部变量prevCloud并将其复制cloud到其中,而不是复制到该prevCloud字段中。因此,如果该字段的值在 之前为 null if {},则在之后它仍然为 null if {},因此当您尝试取消引用它时会引发错误。

于 2012-07-23T02:11:25.807 回答
0

可能这段代码对你有帮助,云端保存在一个“pcd”文件中,看看这里

其他选项是使用 PCL 的“Kinfu”项目

于 2012-08-15T14:49:40.497 回答