显示点云有使用vtk的,有使用 ros 中riz ?库的,使用pcl显示点云数据比较方便,但是对于一些模型形状只能固定特定的效果,比如说直线段,只能绘制点到点两点之间的线段。但是项目需要绘制点1到点2到...点n多条线段的连接,并且绘制设置线段宽度。

步骤:

1、把

 vtkRenderWindowInteractorFix.cpp 
 vtkRenderWindowInteractorFix.h
 pcl_visualizer.h 
 pcl_visualizer.cpp
 shapes.h
shapes.cpp
这几个文件加入到工程P里,修改其依赖的头文件路径;屏蔽之前项目中使用的这三个头文件;添加编译这三个文件所依赖的vtk库。
2、代码修改
/*****自定义多点连接线段,可以设置线段宽度*****/
pcl_visualizer.cpp
/*****自定义多点连接线段,可以设置线段宽度*****/
bool pcl::visualization::PCLVisualizer::addMultyLine(vtkSmartPointer<vtkPoints> points,float width,double r,double g,double b,const std::string &id, int viewport)
{
    // Check to see if this ID entry already exists (has it been already added to the visualizer?)
    ShapeActorMap::iterator am_it = shape_actor_map_->find (id);
    if (am_it != shape_actor_map_->end ())
    {
      pcl::console::print_warn (stderr, "[addMultyLine] A shape with id <%s> already exists! Please choose a different id and retry.\n", id.c_str ());
      return (false);
    }

    if (points->GetNumberOfPoints() < 2)
    {
      PCL_WARN ("[addMultyLine] point size less 2.\n");
      return (false);
    }

    vtkSmartPointer<vtkDataSet> data = createLine (points);

    // Create an Actor
    vtkSmartPointer<vtkLODActor> actor;
    createActorFromVTKDataSet (data, actor);
    actor->GetProperty ()->SetRepresentationToSurface ();
    actor->GetProperty()->SetLineWidth(width);
    actor->GetProperty()->SetColor(r,g,b);
    addActorToRenderer (actor, viewport);

    // Save the pointer/ID pair to the global actor map
    (*shape_actor_map_)[id] = actor;
    return (true);
}

shape.cpp

vtkSmartPointer<vtkDataSet>
pcl::visualization::createLine (vtkSmartPointer<vtkPoints> points)
{
    vtkSmartPointer<vtkLineSource> lineSource = vtkSmartPointer<vtkLineSource>::New();
    lineSource->SetPoints(points);
    lineSource->Update();
    return (lineSource->GetOutput());
}

例子

   vtkSmartPointer<vtkPoints> points = vtkSmartPointer<vtkPoints>::New();

   double origin[3] = {0.0, 0.0, 0.0};
   double p0[3] = {1.0, 0.0, 0.0};
   double p1[3] = {2.0, 0.0, 0.0};
   double p2[3] = {3.0, 0.0, 0.0};
   double p3[3] = {4.0, 0.0, 0.0};

   points->InsertNextPoint(origin);
   points->InsertNextPoint(p0);
   points->InsertNextPoint(p1);
   points->InsertNextPoint(p2);
   points->InsertNextPoint(p3);
   m_viewerOrg->addMultyLine(points,100,255,0,0,"multiline",0);

效果

 

posted on 2019-02-16 11:19  卡贝天师  阅读(3586)  评论(0编辑  收藏  举报