本帖最后由 木子无影 于 2013-1-11 10:03 编辑
在百度文库里面找到的程序，联系不上原作者十分之六2010。程序有问题，运行不了，自己也不太懂，求高手指导，谢谢！
贴程序老是出现问题，只好附件了，不好意思。
还是把程序分开贴上吧
%====本程序为捷联惯导的解算程序(由惯性器件的输出解算出飞行器的位置、速度、姿态信息)======
clear all;
close all;
clc;
deg_rad=pi/180; %由度转化成弧度
rad_deg=180/pi; %由弧度转化成度
%-------------------------------从源文件中读入数据---------------------------------- fid_read=fopen('IMUout.txt','r'); %path1_Den.dat 是由轨迹发生器产生的数据
[AllData NumofAllData]=fscanf(fid_read,'%g %g %g %g %g %g %g %g %g %g %g %g %g %g %g %g',[17 inf]);
AllData=AllData';
NumofEachData=round(NumofAllData/17);
Time=AllData(:,1);
longitude=AllData(:,2); %经度 单位：弧度
latitude=AllData(:,3); %纬度 单位：弧度
High=AllData(:,4); %高度 单位：米
Ve=-AllData(:,6); % 东向、北向、天向速度 单位：米/妙
Vn=AllData(:,5);
Vu=AllData(:,7);
fb_x=AllData(:,9); %比力（fx，fy，fz）
fb_y=AllData(:,8); %指向右机翼方向为x正方向，指向机头方向为y正向，z轴与x轴和y轴构成右手坐标系 单位：米/秒2
fb_z=-AllData(:,10); %右前上
pitch=AllData(:,11); %俯仰角（向上为正） 单位:弧度
head=-AllData(:,13); %偏航角（偏西为正）
roll=AllData(:,12); %滚转角（向右为正）
omigax=AllData(:,15); %陀螺输出（单位：弧度/秒，坐标轴的定义与比力的相同）
omigay=AllData(:,14); omigaz=-AllData(:,16); %-------------------------------程序初始化--------------------------------------
latitude0=latitude(1);
longitude0=longitude(1); %初始位置 |
|
|
