程序优化思路：

代码对于空间栅格搜索，占用内存比较大。每次判定点云在此栅格中点的时候，都会全部过一遍点集，这是不科学的，应当丢弃存入栅格的点集，以免后面重复计算。

栅格搜索寻找点云的重心，从重心出开始搜索。

clc ;
clear ;
%读取点云，将点云数据读取到lidardata矩阵（n*4的矩阵），但实际中只用到了前三列n*3
lidardata=load('ac.txt');%  显示原始点云
x2=lidardata(:,1);
y2=lidardata(:,2);
z2=lidardata(:,3);
figure(1);
plot3(x2,y2,z2,'.');
xlabel('X');
ylabel('Y');
zlabel('Z');
%计算x/y/z差值，以方便确定空间栅格的大小
minx=min(lidardata(:,1));
miny=min(lidardata(:,2));
minz=min(lidardata(:,3));
maxx=max(lidardata(:,1));
maxy=max(lidardata(:,2));
maxz=max(lidardata(:,3));
x_long=maxx-minx;
y_long=maxy-miny;
z_long=maxz-minz;
length_lidardata=length(lidardata);
after_lidardata=zeros(1,4);%数组的预分配内存%after_lidardata1=zeros(100000,4);
% mycell{200,1} = [];i_C=1;%作为cell数组的列数使用，也就代表空间栅格的个数
a_i=0;%测试for循环次数%以下for循环就是将空间进行栅格化划分，从x/y/z依次以固定空间范围内搜索点
%将同一个空间栅格内的点放到一起，如果搜索的空间没有点，则跳出，不增加栅格数
%size_x size_y size_z   分别代表栅格在x/y/z上的大小
size_x=0.5;
size_y=0.5;
size_z=0.5;for i_z=minz :size_z: maxzfor i_y=miny:size_y:maxyfor i_x=minx:size_x:maxx%前面三个for循环是依次搜索空间，以划分栅格%下面这个for循环  是搜索空间中所有的点，是不是在当前栅格中，如果是则赋给矩阵after_ladardatak=1;for i=1:length_lidardataif (    lidardata(i,1)>=i_x && lidardata(i,1)<=i_x+size_x && ...lidardata(i,2)>=i_y && lidardata(i,2)<=i_y+size_y &&...lidardata(i,3)>=i_z && lidardata(i,3)<=i_z+size_z)after_lidardata(k,1:4)=lidardata(i,:);k=k+1;endend%这里检测after_ladardata数组是不是空集，如果是则跳出此次循环，不增加栅格数%如果不是空集，则将数组赋给cell，增加cell所代表的栅格数目TF=isempty(after_lidardata);a_i=a_i+1;if TF==1continue;endmycell{i_C,1}= after_lidardata;i_C=i_C+1;after_lidardata=[];%用完之后，一定要致空after_ladardataendenddisp("距离算法结束");disp(maxz-i_z);%显示进度所有，无实义
end
%seg_buf
seg_mat_B=zeros(1,4);
% A_B=cell2mat(mycell);
A_A=max(size(mycell));%读取mycell数组的维度，以便进行for循环
seg_buf_mat=[];
%这里的4522代表着cell中矩阵的数量，应尽快用程序解决这个问题
for i_p=2:1:A_Aseg_buf_mat=cell2mat(mycell(i_p,1));seg_buf_number=length(seg_buf_mat);seg_buf_maxz=max(seg_buf_mat(:,3));seg_buf_minz=min(seg_buf_mat(:,3));seg_buf_distance=seg_buf_maxz-seg_buf_minz;if (seg_buf_number>10 && seg_buf_distance<0.1)seg_mat_A=cell2mat(mycell(i_p,1));seg_mat_B=[seg_mat_B;seg_mat_A];end% seg_buf_mat=[];endB_mycell=seg_mat_B;
B_mycell(all(B_mycell==0,2),:)=[];
A=all(B_mycell==0,2);
my_cell_x=B_mycell(:,1);
my_cell_y=B_mycell(:,2);
my_cell_z=B_mycell(:,3);
figure(2);
plot3(my_cell_x,my_cell_y,my_cell_z,'.');xlabel('X');ylabel('Y');zlabel('Z');

matlab对于点云栅格化，并且提取路面（粗糙版）相关推荐

基于MATLAB的点云建筑物轮廓提取与基于平面探测法的点云建筑物提取
博客中轮廓提取使用的点云数据建筑物平面检测使用的点云数据 **两个小的点云处理实验项目,(源码资源****有常(注意目前是有常哦)私我vx:xdsqczkyqs713 ,第一个项目点云建筑物轮廓提取 ...
利用matlab处理点云
本文主要分享利用matlab点云工具的相关模块来处理点云,并通过点云轮廓对点云体积进行简单的估计测量. 目录利用matlab处理点云目录主要的操作流程图 2具体流程 1 点云的读入和显示 2 点 ...
基于像素聚类的分割方法基于slic的方法_博士论文摘要 | 张荣春：数码影像与TLS点云数据融合提取地质结构面方法研究...
<测绘学报> 构建与学术的桥梁拉近与权威的距离数码影像与TLS点云数据融合提取地质结构面方法研究张荣春1,2 1.南京邮电大学地理与生物信息学院, 江苏南京 210023;2.河海 ...
MATLAB: 2018a百度云资源、迅雷资源、安装步骤
原文链接:https://blog.csdn.net/YDC123458/article/details/102696295 MATLAB 2018a 百度云链接:https://pan.baidu. ...
MATLAB 颜色提取器 —— APP 版
MATLAB 颜色提取器 -- APP 版日常设计GUI或者APP时,往往需要与颜色打交道,文章链接: MATLAB 如何画出漂亮的图. 在颜色选取上可以通过颜色对照表来选择合适的颜色,有个不方 ...
激光雷达点云－－点云栅格化(二)
二维点云栅格化优化基本思路:按照点云中的xyz坐标值,直接判断放到相应的栅格中,因为定义每个栅格的大小和多少是知道的,比如我的x值是11.5,每个栅格设置的大小是1m,那我x所在的行就是第12行 ...
基于ROS2开发的点云栅格化
0. 简介最近在收到了很多读者的消息后,我觉得有必要开这个坑,来给大家阐述下如何对激光雷达点云以及图像点云去做栅格化以及体素化的操作.这部分需要各位读者拥有PCL,octomap,ROS2,C++的 ...
matlab从fig图文件中提取数据
matlab从fig图文件中提取数据 lh=findall(gca,'type','line'); cell_l = cellfun('length',get(lh,'xdata')); i_lh=f ...
matlab数学建模可应用到第几章,《MATLAB在数学建模中的应用(第2版)》
<MATLAB在数学建模中的应用(第2版)> 卓金武 (编者)) 基本信息 •出版社: 北京航空航天大学出版社; 第2版 (2014年9月1日) •丛书名: MATLAB开发实例系列图书 ...

matlab对于点云栅格化，并且提取路面（粗糙版）

程序优化思路：

matlab对于点云栅格化，并且提取路面（粗糙版）相关推荐

最新文章

热门文章