資源簡介
用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
評論
共有 條評論