点云滤波算法 一维双向扫描方法 matlab

%% 读数据
[fnamedirpath]=uigetfile（‘*.txt‘‘文件打开对话框‘）;
ffname=[dirpath fname];
Point = importdata（ffname）;
%
%% 显示原地形地貌地物
figure（1）
plot3（Point（:1）Point（:2）Point（:3））;
%显示原始地形
GPoint = find（Point（:4 ）== 1）;
%figure（2）
%plot3（Point（GPoint（:）1）Point（GPoint（:）2）Point（GPoint（:）3））;
%% 初始化
SizeXY=size（Point（:1:2）1）;%获取列数
%实际的地面点数‘
numRG = size（ GPoint1）
ThreString = inputdlg（‘请输入tan阈值‘‘TAN阈值‘）;
Thre = str2num（ThreString{1}）;
ThreString1 = inputdlg（‘请输入高程阈值‘‘阈值‘）;
ThreH = str2num（ThreString1{1}）;
%对组数进行一维二向 
DelPoint1 = 0;
DelPoint2 = 0;
Point（16）=1;Point（15）=1;
%% 数据处理
for i = 2:SizeXY                                              
    ThreH1 = Point（i 3） - Point（i - DelPoint1-13）;%相邻点高程差
    ThreH2 = Point（SizeXY-i+1 3） - Point（SizeXY-i+2 + DelPoint23）;
    ThreS1 = sqrt（（Point（i 2） - Point（i - DelPoint1-12））^2 ...%相邻点水平差
        + （Point（i 1） - Point（i - DelPoint1-11））^2）;
    ThreS2 = sqrt（（Point（SizeXY-i+1 2