matlab練習程序（點雲下采樣）

點雲處理有時因為數據量太大，我們需要對其進行下采樣。

這里的方法是先將點雲填入固定大小的三維網格中，然后每個網格中選一個點生成新的點雲。

新點雲即為下采樣后的點雲。

這里使用斯坦福兔子作為測試點雲。

小兔子pcd下載地址。

原始點雲：

采樣后點雲：

matlab代碼如下：

clear all;
close all;
clc;

pc = pcread('rabbit.pcd');
pcshow(pc);

pc_point = pc.Location;
xlimit = pc.XLimits;
ylimit = pc.YLimits;
zlimit = pc.ZLimits;

cellsize = 0.005;   %定義網格大小
%設置網格數量
W = floor((xlimit(2) - xlimit(1))/cellsize)+1;
H = floor((ylimit(2) - ylimit(1))/cellsize)+1;
D = floor((zlimit(2) - zlimit(1))/cellsize)+1;

%向網格里填數
voxel = cell(W,H,D);
for i =1:length(pc_point)
    I = floor((pc_point(i,1)-xlimit(1))/cellsize)+1;
    J = floor((pc_point(i,2)-ylimit(1))/cellsize)+1;
    K = floor((pc_point(i,3)-zlimit(1))/cellsize)+1;
    voxel{I,J,K} = [voxel{I,J,K};pc_point(i,:)];
end

%以網格中第一個點對原點雲進行下采樣
pointre =[];
for i=1:W
    for j=1:H
        for k=1:D
            if isempty(voxel{i,j,k})==0
                pointre=[pointre;voxel{i,j,k}(1,:)];
            end
        end
    end
end
pcre = pointCloud(pointre);

figure;
pcshow(pcre);