forminfor.m

惯性导航系统传递对准系统模型程序

function data=FormInfor(q_s,attitude_s,v_s,T_s,wepp_s,wiep_s,phi_s,lamda_s,q_m,attitude_m,v_m,T_m,wepp_m,wiep_m,phi_m,lamda_m)
    data(1:4,1)=q_s;
    data(5:7,1)=attitude_s;
    data(8:10,1)=v_s;
    data(11:13,1)=T_s(:,1);
    data(14:16,1)=T_s(:,2);
    data(17:19,1)=T_s(:,3);
    data(20:22,1)=wepp_s;
    data(23:25,1)=wiep_s;
    data(26,1)=phi_s;
    data(27,1)=lamda_s;
    data(1:4,2)=q_m;
    data(5:7,2)=attitude_m;
    data(8:10,2)=v_m;
    data(11:13,2)=T_m(:,1);
    data(14:16,2)=T_m(:,2);
    data(17:19,2)=T_m(:,3);
    data(20:22,2)=wepp_m;
    data(23:25,2)=wiep_m;
    data(26,2)=phi_m;
    data(27,2)=lamda_m;