資源簡介
利用陀螺儀和加表的輸出進行慣導結算,得到飛機的位置,速度,姿態角
代碼片段和文件信息
%====本程序為無人機1的捷聯慣導的解算程序(導航系:東北天,由慣性器件的輸出解算出飛行器的位置、速度、姿態信息)======
%%%%%test1為理想軌跡數據,SINSout1為加陀螺加表誤差的導航解算數據%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
clear?all;
close?all;
clc;
deg_rad=pi/180;???%由度轉化成弧度
rad_deg=180/pi;???%由弧度轉化成度
%-----------------------常值定義區----------------------
Omiga=0.00007272205216643040;
Wiee=[0;0;Omiga];
f=1.0/298.257;
Re=6378245;
g0=9.78;
%-------------------------------從源文件中讀入數據----------------------------------
fid_read=fopen(‘text11.txt‘‘r‘);??????????????????%無人機1由軌跡發生器產生的理想數據
fid_write=fopen(‘SINSout1.txt‘‘w‘);
[AllData?NumofAllData]=fscanf(fid_read‘%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f?%f\n‘[20?inf]);
AllData=AllData‘;?
NumofEachData=round(NumofAllData/20);
Time=AllData(:1);
Time(NumofEachData+1)=Time(NumofEachData);
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件??????12004??2011-03-17?15:30??SINSNavDBT11.m
-----------?---------??----------?-----??----
????????????????12004????????????????????1
評論
共有 條評論