trajection 用Matlab编写的轨迹发生器

用Matlab编写的轨迹发生器，输入初始的位置速度，姿态角，姿态变化等信息，模拟得到陀螺仪输出和加速度计的输出

%%****************开题：轨迹发生器：（东北天）（右前上）***************
clear all
clc
close all
fid_write=fopen（‘text11.txt‘‘w‘）;
%1.起始：
Latitude0=30*pi/180;%纬度：30°
Longitude0=110*pi/180;%经度：110°
High0=5000;%高度5000m

Omiga=0.00007272205216643040;
f=1.0/298.257;
Re=6378245;

pitch0=0*pi/180;%俯仰角：0°
roll0=0*pi/180;%滚转角：0°
head0=0*pi/180;%偏航角：0°
alpha0=0*pi/180;%游动方位角：0°
head0=head0+alpha0;

V0=900*1000/3600;Vmax=1000*1000/3600;an=0;%an法向加速度

Wiee=[0;0;Omiga];

TimeAll1=300;
TimeEach=0.02;
Number1=round（TimeAll1/TimeEach）;

an_pitch=0.01;
pitch_max=2*pi/5;
Time1_pitch=（pitch_max-pitch0）/（an_pitch）;
Number_pitch1=Time1_pitch/TimeEach;

alpha（1）=alpha0;
Longitude（1）=Longitude0;
Latitude（1）=Latitude0;

head（1）=head0;
roll（1）=roll0;
pitch（1）=pitch0;

Time（1）=0;
%飞机起始位置
Rn

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件       8731  2011-03-26 15:03  tra011.m

----------- ---------  ---------- -----  ----

                 8731                    1