2018-01-02:Concatenate the points of two Point Clouds

concatenate denotes series connection, in this tutorial, we will show concatenate two points and concatenate two fields.

  • concatenate two fields:
    This means that two point clouds should have the same number of points.

  • concatenate two points:
    This means taht two point clouds should have the same number of fields and the same data type of every field.


main.cpp

#include<iostream>
#include<pcl/io/pcd_io.h>
#include<pcl/point_types.h>

int main(int argc, char** argv)
{
    if(argc!=2)
    {
        std::cerr<<"Please specify command line argument '-f' or '-p'"<<std::endl;
        exit(0);
    }

    pcl::PointCloud<pcl::PointXYZ> cloud_a, cloud_b, cloud_c;
    pcl::PointCloud<pcl::Normal> n_cloud_b;
    pcl::PointCloud<pcl::PointNormal> p_n_cloud_c;

    cloud_a.width=5;
    cloud_a.height=cloud_b.height=n_cloud_b.height=1;
    cloud_a.points.resize(cloud_a.width*cloud_a.height);

    if(strcmp(argv[1],"-p")==0)
    {
        cloud_b.width=3;
        cloud_b.points.resize(cloud_b.width*cloud_b.height);
    }

    else if(strcmp(argv[1], "-f")==0)
    {
        n_cloud_b.width=5;
        n_cloud_b.points.resize(n_cloud_b.width*n_cloud_b.height);
    }

    else
    {
        std::cerr<<"Unknown argument!Please specify '-p' or '-f'"<<std::endl;
        exit(0);
    }

    for(size_t i=0; i<cloud_a.points.size(); ++i)
    {
        cloud_a.points[i].x=1024*rand()/(RAND_MAX + 1.0f);
        cloud_a.points[i].y=1024*rand()/(RAND_MAX + 1.0f);
        cloud_a.points[i].z=1024*rand()/(RAND_MAX + 1.0f);
    }

    if(strcmp(argv[1], "-p")==0)
    {
        for(size_t i=0; i<cloud_b.points.size(); ++i)
        {
            cloud_b.points[i].x=1024*rand()/(RAND_MAX + 1.0f);
            cloud_b.points[i].y=1024*rand()/(RAND_MAX + 1.0f);
            cloud_b.points[i].z=1024*rand()/(RAND_MAX + 1.0f);
        }
    }

    else if(strcmp(argv[1], "-f")==0)
    {
        for(size_t i=0; i<n_cloud_b.points.size(); ++i)
        {
            n_cloud_b.points[i].normal[0]=1024*rand()/(RAND_MAX + 1.0f);
            n_cloud_b.points[i].normal[1]=1024*rand()/(RAND_MAX + 1.0f);
            n_cloud_b.points[i].normal[2]=1024*rand()/(RAND_MAX + 1.0f);
        }
    }

    std::cerr<<"Cloud A: "<<std::endl;
    for(size_t i=0; i<cloud_a.points.size(); ++i)
    {
       std::cerr<<"     "<<cloud_a.points[i].x<<" "<<cloud_a.points[i].y<<" "
               <<cloud_a.points[i].z<<std::endl;
    }

    std::cerr<<"Cloud B: "<<std::endl;
    if(strcmp(argv[1], "-p")==0)
    {
        for(size_t i=0; i<cloud_b.points.size(); ++i)
        {
            std::cerr<<"    "<<cloud_b.points[i].x<<" "<<cloud_b.points[i].y<<" "
                    <<cloud_b.points[i].z<<std::endl;
        }
    }
    else if(strcmp(argv[1], "-f")==0)
    {
        for(size_t i=0; i<n_cloud_b.points.size(); ++i)
        {
            std::cerr<<"    "
                    <<n_cloud_b.points[i].normal[0]<<" "
                   <<n_cloud_b.points[i].normal[1]<<" "
                  <<n_cloud_b.points[i].normal[2]<<std::endl;
        }
    }


    std::cerr<<"Cloud C: "<<std::endl;
    // concatenate two points
    if(strcmp(argv[1], "-p")==0)
    {
        cloud_c  =cloud_a;
        cloud_c +=cloud_b;
        for(size_t i=0; i<cloud_c.points.size(); ++i)
        {
            std::cerr<<"    "
                    <<cloud_c.points[i].x<<" "
                   <<cloud_c.points[i].y<<" "
                  <<cloud_c.points[i].z<<std::endl;
        }
    }

    //concatenate two fields
    else if(strcmp(argv[1], "-f")==0)
    {
        pcl::concatenateFields(cloud_a, n_cloud_b, p_n_cloud_c);
        for(size_t i=0; i<p_n_cloud_c.points.size(); ++i)
        {
            std::cerr<<"    "
                    <<p_n_cloud_c.points[i].x<<" "
                   <<p_n_cloud_c.points[i].y<<" "
                  <<p_n_cloud_c.points[i].z<<" "
                 <<p_n_cloud_c.points[i].normal[0]<<" "
                <<p_n_cloud_c.points[i].normal[1]<<" "
               <<p_n_cloud_c.points[i].normal[2]<<std::endl;

        }
    }
    return 0;
}

CMakeLists.txt

cmake_minimum_required(VERSION 2.8)

project(concatenate_points)
find_package(PCL 1.2 REQUIRED)

include_directories(${PCL_INCLUDE_DIRS})
link_directories(${PCL_LIBRARY_DIRS})
add_definitions(${PCL_DEFINITIONS})

add_executable(${PROJECT_NAME} "main.cpp")
target_link_libraries(${PROJECT_NAME} ${PCL_LIBRARIES})

The execute results are as follows:


Screenshot from 2018-01-02 20-07-52.png
Screenshot from 2018-01-02 20-08-12.png
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 200,783评论 5 472
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 84,396评论 2 377
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 147,834评论 0 333
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,036评论 1 272
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,035评论 5 362
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,242评论 1 278
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 37,727评论 3 393
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,376评论 0 255
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,508评论 1 294
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,415评论 2 317
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,463评论 1 329
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,140评论 3 316
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,734评论 3 303
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,809评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,028评论 1 255
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 42,521评论 2 346
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,119评论 2 341

推荐阅读更多精彩内容