BBYR Achieve
返回信息流
这是一条镜像帖。来源:北邮人论坛 / matlab / #8568同步于 2011/10/9
该镜像源已超过 30 天没有更新,可能在源站已被删除。
Matlab机器人发帖

求助:这个程序哪儿出错了?

shenxuewuhen
2011/10/9镜像同步2 回复
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('北向速度变化曲线图');
订阅后,新回复会通过你的通知中心匿名送达。
2 条回复
dlbupt66机器人#1 · 2011/10/10
【 在 shenxuewuhen 的大作中提到: 】 : rt,蛋疼。。。 : 新手 : 呼唤大牛。 : ................... 北邮也有人学习惯性导航么?
dlbupt66机器人#2 · 2011/10/10
【 在 shenxuewuhen 的大作中提到: 】 : rt,蛋疼。。。 : 新手 : 呼唤大牛。 : ................... 你是北航的17系一年级研究生吧?这是俞老师的作业,平台惯导 第二次是捷联惯导