受下面两个博客启发,撰写了基于最小二乘法的平面拟合程序,在此感谢两位博主。
https://blog.csdn.net/konglingshneg/article/details/82585868
https://blog.csdn.net/shenziheng1/article/details/51175383
%平面方程的一般表达式为:Ax+By+Cz+D=0
%移项得到:z=(-A/C)*x+(-B/C)*y+(-D/c)
%令:a0=-A/C,a1=-B/C,a2=-D/c
%平面方程表达式变为:z=a0*x+a1*y+a2
%这里利用最小二乘法求出a0,a1,a2,然后再得出平面的法向量和归一化法向量
%% 平面拟合算法
clc,clear,close all
data=importdata('data.txt'); % 读取坐标文件,大家可以根据这个栗子举一反三
x=data(:,1);%定义点的x坐标
y=data(:,2);%定义点的y坐标
z=data(:,3);%定义点的z坐标
x_avr = sum(x)/length(data);% 求取法方程组系数,下同
y_avr = sum(y)/length(data);
z_avr = sum(z)/length(data);
xx_avr = sum(x.*x)/length(data);
yy_avr = sum(y.*y)/length(data);
zz_avr = sum(z.*z)/length(data);