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

指北方位平台惯导系统导航解算报告姓名：苏森学号：SY1217227手机京航空航天大学仪器科学与光电工程学院2012年10月目的1熟悉指北方位平台惯导系统的工作原理；2根据加速度传感器输出的比力信息编写算法程序实现对东北方向速度及经纬度的解算；3 进一步掌握惯导的推导及解算技巧，为以后的学习打下基础。二 原理分析利用加速度传感器输出的比例信息求解系统加速度的原理如下所示，在指北方位系统中， (1)写成分量形式，(2)式中： (3) (4)在本次作业中，飞机的高度不发生改变，因此，则上式可改写为， (5)将上式分别作积分可得到飞机在东、北方向的速度为， (6)再次积分可得到系统的经度为， (7)根据得到的经纬度及速度信息计算平台的指令角速度为， (8)三 解算结果及程序流程图通过程序解算得到系统的经纬度坐标曲线如图1所示，图1系统的警卫度坐标曲线系统东、北方向的指令角速度与文件中的指令角速度误差曲线分别如图2、图3所示，图2飞机绕x轴方向指令角速度误差曲线图3飞机绕y轴方向指令角速度误差曲线通过程序解算的最终结果如表1所示，经纬度及东向、北向速度解算结果表1项目数据纬度/°116.3487484205572经度/°40.065340062956338东向速度(m/s)-63.623262815480409北向速度(m/s)63.655491100314300本次作业分别用matlab与C语言编程实现了对指北方位平台惯导系统速度、经纬度以及指令角速度的解算，其程序流程图如图4所示，图4 解算程序流程图通过C语言解算的最终结果如图5所示图5 C语言解算结果四 学习小结通过程序解算，得到了飞机飞行的实际轨迹并计算了平台的指令角速度，更深刻的理解了指北方位惯导系统的工作原理及结算方法。本次结算中的积分运算采用了前向切线逼近的方法，会存在一定的原理误差，为了减小原理误差，可分别采用前向逼近和后向逼近再取平均的方法，原理如图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);）。学习惯导这门课已经有一个月了，但惯导对我来说是一门全新的课程，在学习中遇到很多困难。在课下我有熟悉了力学方面的知识并对书中解算公式做了自行推导，掌握了惯导学习的一些技巧，也感谢俞老师课上精彩的讲解，往后还需再接再厉，学好惯导系统这门课。另外建议老师检查文件中的天向指令角速度的值是否有误。因为用程序结算出的结果与文件中的值有很大差异,如图7(a)(b)所示。通过C语言读出的第三万组附近的值如图8所示，其中第四列为天向指令角速度，在纬度为40度附近时有如此大的指令角速度是不太可能的。图6 积分运算两种不同的算法(a) (b)图7指令角速度，(a)为文件给定指令角速度(b)为解算指令角速度图8jlfw文件中的数值五 源程序matlab源程序clear allclcclose allload(F:\fw.mat)format long;%%%%%%%%%%%%%%%%%%%%%%%%变量的定义及预处理%%%%%%%%%%%%%%%%%%%%%%%%%%%%%J=zeros(1,60001);%定义经度数组变量L=zeros(1,60001);%定义纬度数组变量a=zeros(1,2);%定义加速度数组变量用于存放东向和北向的加速度a2=zeros(1,2);%用于存放有害加速度v=zeros(1,2);%用于存放东向和北向的速度w2=zeros(3,60001);%用于存放结算出的指令角速度t=0:0.01:600;%飞机飞行时间erro=zeros(3,60001);%用于存放东北天方向的指令角速度误差J(1)=116.344762072818;%初始经度L(1)=39.981430918136;%初始纬度Re=6378245;%地球长轴半径w1=0.000072921;%地球自转角速度e=1/298.3%地球的椭球度J(1)=J(1)/(180/pi);L(1)=L(1)/(180/pi);%将初始经纬度转换为弧度%%%%%%%%%%%%%%%%%%%%%%%%%%进行解算%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%for i=1:60001 Rx=Re/(1-e*(sin(L(i))^2));%与子午面垂直平面上的主曲率半径 Ry