資源簡(jiǎn)介
本代碼用MATLAB代寫,可以實(shí)現(xiàn)散點(diǎn)對(duì)最佳平面的擬合,并求解出abcd值,適用于機(jī)構(gòu)光標(biāo)定和機(jī)器人手眼標(biāo)定
代碼片段和文件信息
%?隨機(jī)生成一組(xyz)這些點(diǎn)的坐標(biāo)離一個(gè)空間平面比較近??
%?x0=1;
%?L1=2;??
%?y0=1;
%?L2=2;??
%?x=x0+rand(201)*L1;??
%?y=y0+rand(201)*L2;??
%?z=1+2*x+3*y;??
x=data(:1);
y=data(:2);
z=data(:3);
figure(1)scatter3(xyz‘filled‘)??
hold?on;??
??
planeData=[xyz];??
??
%?協(xié)方差矩陣的SVD變換中,最小奇異值對(duì)應(yīng)的奇異向量就是平面的方向??
xyz0=mean(planeData1);??
centeredPlane=bsxfun(@minusplaneDataxyz0);??
[USV]=svd(centeredPlane);??
??
a=V(13);??
b=V(23);??
c=V(33);??
d=-dot([a?b?c]xyz0);??
??
%?圖形繪制??
評(píng)論
共有 條評(píng)論