惯性导航捷联算法MATLAB实现

捷联算法仿真，希望大虾可以帮忙指正，小弟第一次上传东西

%姿态的解算
%采用Calibrated Sensor Data new runge-kuta

%初始化
clear all
%DATA=textread（‘e:\Mt9data\shixiong\MT9_cal_000071C5_002.log‘）;                                                   %read data
DATA=textread（‘f:\xx\MT_cal_00300507_002.log‘）;                                                   % Mti data
%DATA=textread（‘e:\Mt9data\new525\MT9_cal_000071C5_003.log‘）;                                                   %read data

Wib1=DATA（:（5:7））;
fb1=DATA（:（2:4））;                  %n*3
sizeDATA=size（DATA）;
clear DATA;
jingdu=2.02;
weidu=0.68;
gaodu=0;                                                                    %初始经度为2.02rad，纬度0.68rad高度为0（longitude 116 degreeslatitude 39）
wie=7.292*10^-5;                                                                                %地球自转角

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

     文件       9545  2010-03-20 19:11  xx\mti_calibrated.m

     文件     330221  2010-03-20 19:04  xx\MT_cal_00300507_002.log

     目录          0  2010-03-20 21:19  xx

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

               339766                    3