init_path.m

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

function Init_Path(initvel, initacc, initpos, initll, initeular, data_PM)

initll=[45.7796*Deg_Rad;126.6705*Deg_Rad;0];
Cms=Eular_T([60/60*Deg_Rad;3*60/60*Deg_Rad;2*60/60*Deg_Rad],2,1);
error=[G_Drift;A_bias];
fly='linear motion';
segparam=fly_type(fly,step);