W_AYF0726的博客

Q_idle=[0.9449, 0.1091, 0.2182, 0.2182];t_idle=[10 20 30];[a_idle(1),a_idle(2),a_idle(3)]=quat2angle(Q_idle);a_idle=a_idle/pi*180;Q_svd=[0.944924 0.109078 0.2182 0.218198];t_svd=[10.0068 20.0083...

up= textread('PlanePoint2.txt');%三维点 err_out= textread('err_plane2.txt');%误差txt err_out= err_out; x=up(:,1); y=up(:,2); z=up(:,3); %max:0.829911min:-1.05023var0.1789 %max:0.784398min:-1...