NO.1计算任一点的坡度(左三角)
function y = f1(x)
bb=b*pi/180; %b为已知点的坡度 %角度转化成弧度制
c1=c/2; %c为换能器开角的角度 %c1为换能器开角的一半
cc=c1*pi/180; %角度转化成弧度制
y=D*sin(cc)/sin(pi/2+bb-cc); %D为某点的高度或深度
end
NO.2 计算任一点的坡度(右三角)
function y = f2(x)
bb=b*pi/180; %b为已知点的坡度 %角度转化成弧度制
c1=c/2; %c为换能器开角的角度 %c1为换能器开角的一半
cc=c1*pi/180; %角度转化成弧度制
y=D*sin(cc)/sin(pi/2-bb-cc); %D为某点的高度或深度
end
NO.3 拟合平面
function [A,B,C,D] = fitPlane_SVD(data)
% 功能:利用SVD拟合平面
% 输入:data - 原始数据(m*3) 即x,y,z
% 输出:planes - 拟合所得平面参数
points = data(:,1:3);
% 去质心
M = points- repmat(mean(points),size(points,1),1);
% 奇异值分解
[~,~,V] = svd(M,0);
% 最小特征值对应的特征向量为法向量
normal = V(:,3)';
% 平面参数标准化
dtmp = mean(points*normal');
planes(1:3) = normal