gjwcxs.m

利用奇异值法（SVD）对载入数据进行主成分分析

function S=gjwcxs(dW,N)  %参数为视加速度和视加速度矩阵的长度
%计算工具误差系数
g0=9.78;                  % 单位：米/秒^2（m/s2）         引力加速度常量
Sec_Rad=pi/(180*3600);    % 角秒－>弧度
Min_Rad=pi/(180*60);      % 角分－>弧度
for i=1:N                 %计算出Sw,S1,S2,S3,S4,S5,S6
    tn=0.02;          % 遥测时间间隔
    dWx(i)=dW(i,2);   % x方向的遥测视加速度                        
    dWy(i)=dW(i,3);   % y方向的遥测视加速度
    dWz(i)=dW(i,4);   % z方向的遥测视加速度
    Sw(3*i-2:3*i,1:3)=[0,-dWz(i),dWy(i);dWz(i),0,-dWx(i);-dWy(i),dWx(i),0];
    S1(i,1:4)=Sec_Rad*[tn,dWz(i)/g0,dWx(i)/g0,dWy(i)/g0];
    S2(i,1:4)=Sec_Rad*[tn,dWz(i)/g0,dWy(i)/g0,dWx(i)/g0];
    S3(i,1:4)=Sec_Rad*[tn,dWy(i)/g0,dWz(i)/g0,dWx(i)/g0];
    S4(i,1:4)=[10^(-4)*g0,10^(-5)*dWx(i),Min_Rad*dWy(i),-Min_Rad*dWz(i)];
    S5(i,1:4)=[10^(-4)*g0,10^(-5)*dWy(i),-Min_Rad*dWx(i),Min_Rad*dWz(i)];
    S6(i,1:4)=[10^(-4)*g0,10^(-5)*dWz(i),Min_Rad*dWx(i),-Min_Rad*dWy(i)];
end
IS1(1,1:4)=S1(1,1:4);  %S1的积分
IS2(1,1:4)=S2(1,1:4);  %S2的积分
IS3(1,1:4)=S3(1,1:4);  %S3的积分
for i=1:(N-1)            %计算出SA
    IS1(i+1,1:4)=IS1(i,1:4)+S1(i+1,1:4);
    IS2(i+1,1:4)=IS2(i,1:4)+S2(i+1,1:4);
    IS3(i+1,1:4)=IS3(i,1:4)+S3(i+1,1:4);
end
for i=1:N 
    Sa1=Sw(3*i-2:3*i,1:3)*[IS1(i,:),0,0,0,0,0,0,0,0;0,0,0,0,IS2(i,:),0,0,0,0;0,0,0,0,0,0,0,0,IS3(i,:)];
    Sa2=[S4(i,:),0,0,0,0,0,0,0,0;0,0,0,0,S5(i,:),0,0,0,0;0,0,0,0,0,0,0,0,S6(i,:)];    
    SA(3*i-2:3*i,1:24)=[Sa1,Sa2];
end
ST=[1,0,0;0,1,0;0,0,1];
Sv(1:3,1:27)=[SA(1:3,1:24),ST];
for i=1:(N-1)             %计算出Sv
    Sv(3*(i+1)-2:3*(i+1),1:27)=[Sv(3*i-2:3*i,1:24)+SA(3*(i+1)-2:3*(i+1),1:24),ST];
end
SR(1:3,1:27)=Sv(1:3,1:27);
for i=1:(N-1)             %计算出SR
    SR(3*(i+1)-2:3*(i+1),1:27)=SR(3*i-2:3*i,1:27)+Sv(3*(i+1)-2:3*(i+1),1:27);
end    
for i=1:N                 %计算出S
    S(6*i-5:6*i,1:27)=[Sv(3*i-2:3*i,1:27);SR(3*i-2:3*i,1:27)];
end