返回信息流rt,蛋疼。。。
新手
呼唤大牛。
会不会是循环出错了,还是矩阵设置错了?
clc
clear
close all
data=load('C:\Documents and Settings\Administrator\桌面\2011秋《惯性导航原理》第一次作业\fw.dat');
w_ins=data(:,2:4);%陀螺仪角速度信息
f_ins=data(:,5:7);%比力信息
l0=size(data,1);%l0为数据个数
wie=7.292115147e-5;%地球自转角速度
re=6378245;%地球椭球长半径
h=37.74319;%飞行高度
e=1/298.3;%第一偏心率
vx=zeros(1,l0);
vy=zeros(1,l0);
vz=zeros(1,l0);
lam=zeros(1,l0);
l=zeros(1,l0);
%初始经纬度
lam(1)=116.343692076;
l(1)=40.162565402;
%初始速度
vx(1)=0.0;
vy(1)=0.0;
vz(1)=0.0;
for i=1:l0
f_t=f_ins(i,:);
w_t=w_ins(i,:);
rm(i)=re*(1-2*e+3*e*sin(l(i))^2);%计算子午圈主曲率半径
rn(i)=re*(1+e*sin(l(i))^2);%计算卯酉圈主曲率半径
vx(i)=f_t(1)+2*wie*sin(l(i))*vy(i)+vx(i)*vy(i)*tan(l(i))/rn(i)+vx(i);%指东速度
vy(i)=f_t(2)-2*wie*sin(l(i))*vx(i)+vx(i)*vx(i)*tan(l(i))/rn(i)+vy(i);%指北速度
lam(i)=vx(i)/cos(l(i))/rn(i)+lam(i);%经度计算
if lam(i)>pi
lam(i)=lam(i)-2*pi;
end
l(i)=vy(i)/rm(i)+l(i);%纬度计算
if l(i)>(pi/2)
l(i)=pi-l(i);
end
end
%绘制曲线图
figure
plot(l,lam)%绘制经度变化曲线图
grid on
Xlabel('经度');Ylabel('纬度');title('经纬度变化曲线图');
figure
plot(t,vx);
grid on
Xlabel('时间/秒');Ylabel('东向速度Vx米/秒');title('东向速度变化曲线图');
figure
plot(t,vy);
grid on
Xlabel('时间/秒');Ylabel('北向速度Vx米/秒');title('北向速度变化曲线图');
这是一条镜像帖。来源:北邮人论坛 / matlab / #8568同步于 2011/10/9
该镜像源已超过 30 天没有更新,可能在源站已被删除。
Matlab机器人发帖
求助:这个程序哪儿出错了?
shenxuewuhen
2011/10/9镜像同步2 回复
订阅后,新回复会通过你的通知中心匿名送达。