initial_data.m

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

function data=Initial_data(attitude0,Tbn0,v0,phi0,lamda0);
global Re e wie;
q_m = dcm_qua(Tbn0);
attitude_m = attitude0;
v_m = v0;
T_m = Tbn0;
phi_m = phi0;
lamda_m = lamda0;
wiep_m (1,1) = 0;
wiep_m (2,1) = wie*cos(phi_m);
wiep_m (3,1) = wie*sin(phi_m);
Rn = Re*(1+e*sin(phi_m)*sin(phi_m));
Rm = Re*(1-2*e+3*e*sin(phi_m)*sin(phi_m));
wepp_m(1,1) = -v_m(2)/Rm;
wepp_m(2,1) = v_m(1)/Rn;
wepp_m(3,1) = v_m(1)*tan(phi_m)/Rn;
q_s = q_m;
attitude_s = attitude_m;
v_s = v_m;
T_s = T_m;
wepp_s = wepp_m;
wiep_s = wiep_m;
phi_s = phi_m;
lamda_s = lamda_m;
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);