初始对准程序文.pdfVIP

初始对准程序，大家多多研究，多多讨论！ close all; clear all; clc; format long %初始化参数 %vx(1)=0.000048637; %vy(1)=0.000206947; %vz(1)=0.007106781; % 初始速度 vx(1)=0; vy(1)=0; vz(1)=0; jd(1)=116.344695283*2*pi/360; L(1)=39.975172*2*pi/360; %初始经纬度 %B(1)=-91.637207*2*pi/360; % 初始航向角 tian %C(1)=0.120992605*2*pi/360; %初始俯仰角 dong %D(1)=0.010445947*2*pi/360; %初始横滚角 bei %初始姿态角 B(1)=0; C(1)=0; D(1)=0; re=6378245; Wie=7.27221e-5; e=1/298.3; Ti=1/20; j=100; N=200; g=9.78049; Wib