指北方位平台惯导系统导航解算报告

《指北方位平台惯导系统导航解算报告》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、指北方位平台惯导系统导航解算报告姓名：苏森学号：SY1217227手机：13552882138北京航空航天大学仪器科学与光电工程学院2012年10月10指北方位惯导系统解算报告SY1217227苏森一目的1熟悉指北方位平台惯导系统的工作原理；2根据加速度传感器输出的比力信息编写算法程序实现对东北方向速度及经纬度的解算；3进一步掌握惯导的推导及解算技巧，为以后的学习打下基础。二原理分析利用加速度传感器输出的比例信息求解系统加速度的原理如下所示，在指北方位系统中，Vt=ft-2ωiet+ωett×Vt+gt(1)写成分量形式，VxtVytVzt=fxtfytfzt-0-2ωiezt+ωetzt2ω

2、ieyt+ωetyt2ωiezt+ωetzt0-2ωiext+ωetxt-2ωieyt+ωetyt2ωiext+ωetxt0VxtVytVzt+00-g(2)式中：ωiet=ωiextωieytωiezt=0ωiecosLωiesinL(3)ωett=ωetxtωetytωetzt=-VetytRytVetxtRxtVetxtRxttgL(4)在本次作业中，飞机的高度不发生改变，因此Vzt=0，则上式可改写为，Vxt=fxt+2ωiesinL∙Vgt+VxtVytRxttgLVyt=fyt-2ωiesinL∙Vxt-VxtVxtRxttgL(5)将上式分别作积分可得到飞机在东、北方向的速度为，

3、Vxt=0tVxtdt+Vx0tVyt=0tVytdt+Vy0t(6)再次积分可得到系统的经度为，10指北方位惯导系统解算报告SY1217227苏森L=0tVytRytdt+L0λ=0tVxtRxtsecLdt+λ0(7)根据得到的经纬度及速度信息计算平台的指令角速度为，ωipp=-VetytRytωiecosL+VetxtRxtωiesinL+VetxtRxttgL=ωipxpωipypωipzp(8)三解算结果及程序流程图通过程序解算得到系统的经纬度坐标曲线如图1所示，图1系统的警卫度坐标曲线系统东、北方向的指令角速度与文件中的指令角速度误差曲线分别如图2、图3所示，10指北方位惯导系统解

4、算报告SY1217227苏森图2飞机绕x轴方向指令角速度误差曲线图3飞机绕y轴方向指令角速度误差曲线通过程序解算的最终结果如表1所示，经纬度及东向、北向速度解算结果10指北方位惯导系统解算报告SY1217227苏森表1项目数据纬度/°116.3487484205572经度/°40.065340062956338东向速度(m/s)-63.623262815480409北向速度(m/s)63.655491100314300本次作业分别用matlab与C语言编程实现了对指北方位平台惯导系统速度、经纬度以及指令角速度的解算，其程序流程图如图4所示，图4解算程序流程图通过C语言解算的最终结果如图5所示1

5、0指北方位惯导系统解算报告SY1217227苏森图5C语言解算结果四学习小结通过程序解算，得到了飞机飞行的实际轨迹并计算了平台的指令角速度，更深刻的理解了指北方位惯导系统的工作原理及结算方法。本次结算中的积分运算采用了前向切线逼近的方法，会存在一定的原理误差，为了减小原理误差，可分别采用前向逼近和后向逼近再取平均的方法，原理如图6所示（以y=2x积分为例，三种算法分别为y(1,i)=t(i)^2;y(2,i)=y(2,i-1)+2*t(i-1);y(3,i)=y(3,i-1)+2*t(i);）。学习惯导这门课已经有一个月了，但惯导对我来说是一门全新的课程，在学习中遇到很多困难。在课下我有熟悉了

6、力学方面的知识并对书中解算公式做了自行推导，掌握了惯导学习的一些技巧，也感谢俞老师课上精彩的讲解，往后还需再接再厉，学好惯导系统这门课。另外建议老师检查文件中的天向指令角速度的值是否有误。因为用程序结算出的结果与文件中的值有很大差异,如图7(a)(b)所示。通过C语言读出的第三万组附近的值如图8所示，其中第四列为天向指令角速度，在纬度为40度附近时有如此大的指令角速度是不太可能的。10指北方位惯导系统解算报告SY1217227苏森图6积分运算两种不同的算法(a)(b)图7指令角速度，(a)为文件给定指令角速度(b)为解算指令角速度10指北方位惯导系统解算报告SY1217227苏森图8jlfw文

7、件中的数值五源程序1matlab源程序clearallclccloseallload('F:fw.mat')formatlong;%%%%%%%%%%%%%%%%%%%%%%%%变量的定义及预处理%%%%%%%%%%%%%%%%%%%%%%%%%%%%%J=zeros(1,60001);%定义经度数组变量L=zeros(1,60001);%定义纬度数组变量a=zeros(1,2);%定义加速度数