2016-04-28 845 views
1

我想显示一个点云,由顶点和颜色与OSG组成。用这个guide来显示静态点云是相当容易的。如何正确更新几何图形

但我不能更新这样的点云。我的意图是创建一个几何图形并将其附加到我的观察器类一次。

这是在开始时被调用一次的所述方法。

OSGWidget强烈依赖于此OpenGLWidget based approach

void OSGWidget::attachGeometry(osg::ref_ptr<osg::Geometry> geom) 
{ 
osg::Geode* geode = new osg::Geode; 

geom->setDataVariance(osg::Object::DYNAMIC); 
geom->setUseDisplayList(false); 
geom->setUseVertexBufferObjects(true); 
bool addDrawSuccess = geode->addDrawable(geom.get()); // Adding Drawable Shape to the geometry node 


if (!addDrawSuccess) 
{ 
    throw "Adding Drawable failed!"; 
} 

{ 
    osg::StateSet* stateSet = geode->getOrCreateStateSet(); 
    stateSet->setMode(GL_LIGHTING, osg::StateAttribute::OFF); 
} 

float aspectRatio = static_cast<float>(this->width())/static_cast<float>(this->height()); 

// Setting up the camera 
osg::Camera* camera = new osg::Camera; 
camera->setViewport(0, 0, this->width(), this->height()); 
camera->setClearColor(osg::Vec4(0.f, 0.f, 0.f, 1.f)); // Kind of Backgroundcolor, clears the buffer and sets the default color (RGBA) 
camera->setProjectionMatrixAsPerspective(30.f, aspectRatio, 1.f, 1000.f); // Create perspective projection 
camera->setGraphicsContext(graphicsWindow_); // embed 

osgViewer::View* view = new osgViewer::View; 
view->setCamera(camera);     // Set the defined camera 
view->setSceneData(geode);     // Set the geometry 
view->addEventHandler(new osgViewer::StatsHandler); 


osgGA::TrackballManipulator* manipulator = new osgGA::TrackballManipulator; 
manipulator->setAllowThrow(false); 

view->setCameraManipulator(manipulator); 

/////////////////////////////////////////////////// 
// Set the viewer 
////////////////////////////////////////////////// 
viewer_->addView(view); 
viewer_->setThreadingModel(osgViewer::CompositeViewer::SingleThreaded); 
viewer_->realize(); 

this->setFocusPolicy(Qt::StrongFocus); 
this->setMinimumSize(100, 100); 

this->setMouseTracking(true); 
} 

后,我已经 '连接' 的几何形状,我想更新这样

void PointCloudViewOSG::processData(DepthDataSet depthData) 
{ 
if (depthData.points()->empty()) 
{ 
    return; // empty cloud, cannot do anything 
} 

const DepthDataSet::IndexPtr::element_type& index = *depthData.index(); 
const size_t nPixel = depthData.points().get()->points.size(); 

if (depthData.intensity().isValid() && !index.empty()) 
{ 
    for (int i = 0; i < nPixel; i++) 
    { 
     float x = depthData.points().get()->points[i].x; 
     float y = depthData.points().get()->points[i].y; 
     float z = depthData.points().get()->points[i].z; 
     m_vertices->push_back(osg::Vec3(x 
      , y 
      , z)); 

     // 32 bit integer variable containing the rgb (8 bit per channel) value 
     uint32_t rgb_val_; 
     memcpy(&rgb_val_, &(depthData.points().get()->points[i].rgb), sizeof(uint32_t)); 

     uint32_t red, green, blue; 
     blue = rgb_val_ & 0x000000ff; 

     rgb_val_ = rgb_val_ >> 8; 
     green = rgb_val_ & 0x000000ff; 

     rgb_val_ = rgb_val_ >> 8; 
     red = rgb_val_ & 0x000000ff; 

     m_colors->push_back(
      osg::Vec4f((float)red/255.0f, 
      (float)green/255.0f, 
       (float)blue/255.0f, 
       1.0f) 
     ); 
    } 

    m_geometry->setVertexArray(m_vertices.get()); 

    m_geometry->setColorArray(m_colors.get()); 

    m_geometry->setColorBinding(osg::Geometry::BIND_PER_VERTEX); 

    m_geometry->addPrimitiveSet(new osg::DrawArrays(osg::PrimitiveSet::POINTS, 0, m_vertices->size()));  
    } 
} 

我的猜测是几何形状的

addPrimitiveSet(...)

每次我更新几何时都不应该被调用。

或者它可以是几何体的附件,所以我必须每次重新附加它?

不幸的是,由于与我的应用程序不兼容,PointCloudlibrary(PCL)不是一种替代方案。更新

this->attachGeometry(m_geometry) 后,当我重新连接几何到OSGWidget类, 调用

m_geometry->addPrimitiveSet(new osg::DrawArrays(osg::PrimitiveSet::POINTS, 0, m_vertices->size()));

我得到我的点云可见,但这个过程肯定是不对的因为我失去了太多的性能和显示驱动程序崩溃。

回答

2

您需要设置阵列,并添加原始设定一次,之后你可以更新的顶点是这样的:

osg::Vec3Array* vx = static_cast<osg::Vec3Array*>(m_vertices); 
for (int i = 0; i < nPixel; i++) 
{ 
    float x, y, z; 

    // fill with your data... 

    (*vx)[i].set(x, y, z); 
} 
m_vertices->dirty(); 

也是一样的颜色和其他阵列。
当你正在使用VBO,你并不需要调用dirtyDisplayList()
如果你需要,而不是到recompure几何形状的边框,请拨打

m_geometry->dirtyBound() 

万一之间点的数量变化更新,你可以把新的顶点到数组如果尺寸过小,并更新PrimitiveSet指望这样的:

osg::DrawArrays* drawArrays = static_cast<osg::DrawArrays*>(m_geometry->getPrimitiveSet(0)); 
drawArrays->setCount(nPixel); 
drawArrays->dirty(); 
+0

但是,如果像素(nPixel)的数量保持不变,这是否仅适用? –

+0

Sure @DanielR。我是在这个假设下,我正在编辑回复,以考虑不同的点数 – rickyviking

+0

谢谢。我的临时解决方案是重置原始集,vertexset和colorset。但正如你所说,我不必这样做 –