精心整理
惯性导航系统基本工作原理
惯性导航系统是十分复杂的高精度机电综合系统，只有当科学技术发展到一定高度时工程上才能实现这种系统，但其基本工作原理却以经典的牛顿力学为基础。
设质量m 受弹簧的约束，悬挂弹簧的壳体固定在载体上，载体以加速度a 作水平运动，则m
处于平衡后，所受到的水平约束力F 与a 的关系满足牛顿第二定律：F a m
=。测量水平约束力F ，求的a ，对a 积分一次，即得水平速度，再积分一次即得水平位移。以上所述是简单化了的理性情况。由于运载体不可能只作水平运动，当有姿态变化时，必须测得沿固定坐标系的加速度，所以加速度计必须安装在惯性平台上，平台靠陀螺维持要求的空间角位置，导航计算和对平台的控制由计算机完成。
陀螺仪组件测取沿运载体坐标系3个轴的角速度信号，并被送入导航计算机，经误差补偿计算后进行姿态矩阵计算。加速度计组件测取沿运载体坐标系3个轴的加速度信号，并被送入导航计算机，经误差补偿计算后，进行由运载体坐标系至“平台坐标系”的坐标变换计算。他们沿机体坐标系三轴安装，并且与机体固连，它们所测得的都是机体坐标系下的物理量。
参与控制和测量的陀螺和加速度计称为惯性器件，这是因为陀螺和加速度计都是相对惯性空间测量的，也就是说加速度计输出的是运载体的绝对加速度，陀螺输出的是运载体相对惯性空间的角速度或角增量。而加速度和角速度或角增量包含了运载体全部的信息，所以惯导系统仅靠系统本身的惯性器件就能获得导航用的全部信息，它既不向外辐射任何信息，也不需要任何其他系统提供外来信息，就能在全天候条件下，在全球范围内和所有介质环境里自主、隐蔽的进行三维导航，也可用于外层空间的三维导航。
惯导系统的比力方程
惯导系统根据与系统类型相应的数学方程（称之为力学编排）对惯性器件的输出作处理，从而获得导航数据。尽管各种类型的系统相应的力学编排各不相同，但他们都源自同一个方程：比力方程。比力方程描述了加速度计输出量与运载体速度之间的解析关系：
式中：eT v 为运载体的地速向量；f 为比力向量，是作用在加速度计质量块单位质量上的非引力外力，由加速度计测量；g 为重力加速度；ie ω为地球自转角速度；eT ω为惯性平台所模拟的平台
坐标系T 相对地球的旋转角速度；eT dv dt
表示在平台坐标系T 内观察到的地速向量的时间变化率。以上比力方程说明用加速度计的比力输出计算地速时，必须对比力输出中的三种有害加速度成分作补偿：
（1）2ie eT v ω?，即由地球自转（牵连运动）和运载体相对地球运动（相对运动）引起的哥式加速度；
（2）eT eT v ω?，即运载体保持在地球表面运动（绕地球作圆周运动）引起的相对地心的向心
加速度；
（3）g ，即重力加速度。
惯导系统的误差方程
1、姿态误差方程和速度误差方程的一般形式
设惯导系统的平台要求模拟的导航坐标系为n ，这就是理想平台坐标系T 。而实际建立的平台坐标系为P 。由于计算误差、误差源影响及施距误差，P 坐标系相对要求的T 坐标系有偏差角?。显然?是以T 为基准观察到的，所以：
设陀螺的刻度系数误差为Gx K δ，Gy K δ，Gz K δ，漂移为ε，平台的实际指令为
式中in ω?为偏开理想值n in ω的偏差，它由导航误差引起。所以平台的实际角速度为
记x T y z ? ? ???? ?= ? ???
则111z y P T z
x y
x C ????????- ?=- ? ?-?? 所以111z y T P
z x y x C -???-?-???? ?= ? ???
记0[]00z y z x y x -??φ?-?-???? ?= ? ???
则[]T P C I φ=+
因此姿态误差角满足下述方程：
式中diag[G Gx K K δ?=Gy K δ]Gz K δ
推导中略去了关于误差的二阶及二阶以上的小量。
将比力方程向导航坐标系n 投影得
设计加速度具有偏执误差p ?和刻度系数误差Ax K δ，Ay K δ，Az K δ，实际平台坐标系P 具有姿态误差角φ，则加速度计的输出为
用于计算有害加速度的实际角速度为
由于比力输出和补偿有害加速度的计算都有误差，所以按比力方程确定的速度也有误差，设速度误差为v δ，则
略去关于误差的二阶和二阶以上小量，则速度误差方程为
式中diag[A Ax K K δδ=Ay K δ]Az K δ
二．GPS 卫星的轨道参数及状态估计
GPS 卫星的六个轨道根数决定卫星的轨迹，GPS 卫星轨迹产生需知道它的轨道根数。
卫星的轨道根数定义
在二体运动情况下，卫星的轨道可以用六个轨道参数来唯一确定，称之为轨道根数，分别是: (l)长半轴a :卫星轨道椭圆长轴之半，它确定了卫星运动轨道的周期。
(2)轨道离心率e :轨道椭圆两焦点之间的距离与长轴的比值。
(3)轨道倾角i :轨道平面与地球赤道平面之间的夹角，在升交点出赤道而起逆时针方向度量为正，0180i ≤≤。
(4)升交点赤经Ω:春分点与升交点对地心的张角，从升交点起逆时针方向度量为正。
(5)近地点幅角ω:轨道面内出升交点到近地点拱线的夹角，由升交点起顺卫星运动方向度量为正。
(6)卫星过近地点时刻τ。
在卫星的六个轨道根数中，a 、e 确定了卫星轨道的大小和形状，i 和Ω确定了轨道面在惯性空间的位置，ω决定了轨道本身在轨道面内的指向，τ确定了卫星在轨道上的位置。
当0i =或180，或者0e =时，轨道要素存在病态，需要重新定义新的要素以消除病态。 GPS 定位原理
当GPS 接收机观测3颗卫星时，用户可以在指定的方式(手动或自动)进行二维定位，若能观测到4颗以上的卫星，则能进行三维定位。GPS 系统采用的是测距定位原理，如图所示。
由图知，用户U 和卫星S 之间有如下关系：
式中：
u R —地心到用户的矢径
i R —地心到第i 颗卫星i S 的矢径
i ρ—用户到第i 颗卫星i S 的矢径
图3.1GPS 的测距定位原理 设i i ρρ=即用户至卫星的距离。在工程中，由于多种因素的影响，测者无法测出真实距离i ρ，只能测得包含有多种误差因素在内的距离，因此称i ρ为伪距。接收机测得的距离i D 与i ρ关系式为: 式中：
i ρ—接收机至第i 颗卫星的伪距
i D —接收机至第i 颗卫星的真实距离 Ai t ?—为第i 颗星的传播延迟误差 u t ?—用户相对GPS 系统时间的偏差
Si t ?—第i 颗星相对GPS 系统的时间偏差 C —电波传播速度
其中：
式中：Si X 、Si Y 、Si Z ——第i 颗卫星的位置坐标 X 、Y 、Z ——用户的位置坐标 将式（3.13）带入式（3.12）得 其中，X 、Y 、Z 和u t ?是未知数，而卫星坐标、卫星时钟偏差和延迟误差都可在导航电文中获取
或计算出。因此选用四颗GPS 卫星的测量伪距1ρ，2ρ，3ρ，4ρ联立方程即可解出X 、Y 、Z 和u t ?。这就是GPS 的基本工作原理。
惯性导航作业
一、数据说明： 1：惯导系统为指北方位的捷连系统。初始经度为116.344695283度、纬度为39.975172度,高度h为30米。初速度 v0=[-9.993908270;0.000000000;0.348994967]。 2：jlfw中为600秒的数据，陀螺仪和加速度计采样周期分别为为1/100秒和1/100秒。 3：初始姿态角为[2 1 90]（俯仰，横滚，航向,单位为度）,jlfw.mat中保存的为比力信息f_INSc(单位m/s^2)、陀螺仪角速率信息wib_INSc(单位rad/s)，排列顺序为一~三行分别为X、Y、Z向信息. 4: 航向角以逆时针为正。 5:地球椭球长半径re=6378245;地球自转角速度wie=7.292115147e-5;重力加速度g=g0*(1+gk1*c33^2)*(1-2*h/re)/sqrt(1-gk2*c33^2)； g0=9.7803267714;gk1=0.00193185138639;gk2=0.00669437999013;c33=sin(lat纬度); 二、作业要求： 1：可使用MATLAB语言编程，用MATLAB编程时可使用如下形式的语句读取数据：load D:\...文件路径...\jlfw,便可得到比力信息和陀螺仪角速率信息。用角增量法。 2：(1) 以系统经度为横轴，纬度为纵轴（单位均要转换为：度）做出系统位置曲线图； (2) 做出系统东向速度和北向速度随时间变化曲线图（速度单位：m/s，时间单位：s）； (3) 分别做出系统姿态角随时间变化曲线图（俯仰，横滚，航向,单位转换为：度，时间单位：s）； 以上结果均要附在作业报告中。 3：在作业报告中要写出“程序流程图、现阶段学习小结”，写明联系方式。
电子陀螺仪工作原理 内容来源网络，由“深圳机械展（11万㎡，1100多家展商，超10万观众）”收集整理！更多cnc加工中心、车铣磨钻床、线切割、数控刀具工具、工业机器人、非标自动化、数字化无人工厂、精密测量、3D打印、激光切割、钣金冲压折弯、精密零件加工等展示，就在深圳机械展. 电子陀螺仪其实就是机械式陀螺仪的进化，机械式是利用真实的陀螺等机械制作的，而电子是利用芯片来实现陀螺仪的功能，其工作原理类似（电子只不过是模拟出来的而已）。 所有陀螺仪的工作原理是一样的：广泛应用于航海、航空和航天领域，种类很多，其中陀螺罗盘就是代替罗盘的装置。 陀螺仪的原理就是，一个旋转物体的旋转轴所指的方向在不受外力影响时，是不会改变的。人们根据这个道理，用它来保持方向，制造出来的东西就叫陀螺仪。陀螺仪在工作时要给它一个力，使它快速旋转起来，一般能达到每分钟几十万转，可以工作很长时间。然后用多种方法读取轴所指示的方向，并自动将数据信号传给控制系统。 最基础的陀螺仪的结构：基础的陀螺仪是一种机械装置，其主要部分是一个对旋转轴以极高角速度旋转的转子，转子装在一支架内； 历史： 1850年法国的物理学家莱昂·傅科（J.Foucault）为了研究地球自转，首先发现高速转
动中的转子（rotor），由于惯性作用它的旋转轴永远指向一固定方向，他用希腊字gyro（旋转）和skopein（看）两字合为gyro scopei 一字来命名这种仪表。 陀螺仪是一种既古老而又很有生命力的仪器，从第一台真正实用的陀螺仪器问世以来已有大半个世纪，但直到现也，陀螺仪仍在吸引着人们对它进行研究，这是由于它本身具有的特性所决定的。陀螺仪最主要的基本特性是它的稳定性和进动性。人们从儿童玩的地陀螺中早就发现高速旋转的陀螺可以竖直不倒而保持与地面垂直，这就反映了陀螺的稳定性。研究陀螺仪运动特性的理论是绕定点运动刚体动力学的一个分支，它以物体的惯性为基础，研究旋转物体的动力学特性。 内容来源网络，由“深圳机械展（11万㎡，1100多家展商，超10万观众）”收集整理！更多cnc加工中心、车铣磨钻床、线切割、数控刀具工具、工业机器人、非标自动化、数字化无人工厂、精密测量、3D打印、激光切割、钣金冲压折弯、精密零件加工等展示，就在深圳机械展.
惯性导航技术综合实验 实验五惯性基组合导航及应用技术实验
惯性/卫星组合导航系统车载实验 一、实验目的 ①掌握捷联惯导/GPS组合导航系统的构成和基本工作原理； ②掌握采用卡尔曼滤波方法进行捷联惯导/GPS组合的基本原理； ③掌握捷联惯导 /GPS组合导航系统静态性能； ④掌握动态情况下捷联惯导 /GPS组合导航系统的性能。 二、实验内容 ①复习卡尔曼滤波的基本原理（参考《卡尔曼滤波与组合导航原理》第二、五章）； ②复习捷联惯导/GPS组合导航系统的基本工作原理（参考以光衢编著的《惯性导航原理》第七章）； 三、实验系统组成 ①捷联惯导/GPS组合导航实验系统一套； ②监控计算机一台。 ③差分 GPS接收机一套； ④实验车一辆； ⑤车载大理石平台； ⑥车载电源系统。 四、实验内容 1）实验准备 ①将IMU紧固在车载大理石减振平台上，确认IMU的安装基准面紧靠实验平台； ②将IMU与导航计算机、导航计算机与车载电源、导航计算机与监控计算
机、GPS 接收机与导航计算机、GPS 天线与GPS 接收机、GPS 接收机与GPS 电池之间的连接线正确连接； ③ 打开GPS 接收机电源，确认可以接收到4颗以上卫星； ④ 打开电源，启动实验系统。 2） 捷联惯导/GPS 组合导航实验 ① 进入捷联惯导初始对准状态，记录IMU 的原始输出，注意5分钟内严禁移动实验车和IMU ； ② 实验系统经过5分钟初始对准之后，进入导航状态； ③ 移动实验车，按设计实验路线行驶； ④ 利用监控计算机中的导航软件进行导航解算，并显示导航结果。 五、 实验结果及分析 (一) 理论推导捷联惯导短时段（1分钟）位置误差，并用1分钟惯导实验数据验证。 1、一分钟惯导位置误差理论推导： 短时段内（t<5min ），忽略地球自转0ie ω=，运动轨迹近似为平面1/0R =，此时的位置误差分析可简化为： （1） 加速度计零偏?引起的位置误差：2 10.88022t x δ?==m （2） 失准角0φ引起的误差：2 02 0.92182g t x φδ==m （3） 陀螺漂移ε引起的误差：3 30.01376 g t x εδ==m 可得1min 后的位置误差值123 1.8157m x x x x δδδδ=++= 2、一分钟惯导实验数据验证结果： （1）纯惯导解算1min 的位置及位置误差图：
【悠牛仪器仪表网】陀螺仪传感器是一个简单易用的基于自由空间移动和手势的定位和控制系统。用来感测和维持方向的装置，它是航空、航海及太空导航系统中判断方位的主要依据，并且在汽车安全，航模，望远镜等领域广泛应用。 主要检测空间某些相位的倾角变化、位置变化，主要用于空间物理领域，特别在航空、航海方面有较多的用途，如：飞机上的陀螺仪，当飞机在做360°翻转的时候，陀螺仪将会保持原始的基准状态不变，从而让驾驶员找到本飞机在空间状态的相位变化，也就是：当时飞机处在什么相位。 陀螺仪传感器原理 一个旋转物体的旋转轴所指的方向在不受外力影响时，是不会改变的。人们根据这个道理，用它来保持方向，制造出来的东西就叫陀螺仪。我们骑自行车其实也是利用了这个原理。轮子转得越快越不容易倒，因为车轴有一股保持水平的力量。陀螺仪在工作时要给它一个力，使它快速旋转起来，一般能达到每分钟几十万转，可以工作很长时间。 然后用多种方法读取轴所指示的方向，并自动将数据信号传给控制系统。陀螺仪传感器应用领域以及发展方向现代陀螺仪是一种能够精确地确定运动物体的方位的仪器，它是现代航空，航海，航天和国防工业中广泛使用的一种惯性导航仪器，它的发展对一个国家的工业，国防和其它高科技的发展具有十分重要的战略意义。 传统的惯性陀螺仪主要是指机械式的陀螺仪，机械式的陀螺仪对工艺结构的要求很高，结构复杂，它的精度受到了很多方面的制约。自从上个世纪七十年代以来，现代陀螺仪的发展已经进入了一个全新的阶段。1976年等提出了现代光纤陀螺仪的基本设想，到八十年代以后，现代光纤陀螺仪就得到了非常迅速的发展，与此同时激光谐振陀螺仪也有了很大的发展。 由于光纤陀螺仪具有结构紧凑，灵敏度高，工作可靠等等优点，所以目前光纤陀螺仪在很多的领域已经完全取代了机械式的传统的陀螺仪，成为现代导航仪器中的关键部件。 和光纤陀螺仪同时发展的除了环式激光陀螺仪外，还有现代集成式的振动陀螺仪，集成式的振动陀螺仪具有更高的集成度，体积更小，也是现代陀螺仪的一个重要的发展方向。 陀螺仪传感器分类 根据框架的数目和支承的形式以及附件的性质决定陀螺仪的类型有： 二自由度陀螺仪(只有一个框架，使转子自转轴具有一个转动自由度)。 根据二自由度陀螺仪中所使用的反作用力矩的性质，可以把这种陀螺仪分成三种类型： 积分陀螺仪(它使用的反作用力矩是阻尼力矩);速率陀螺仪(它使用的反作力矩是弹性力矩); 无约束陀螺(它仅有惯性反作用力矩); 现在，除了机、电框架式陀螺仪以外，还出现了某些新型陀螺仪，如静电式自由转子陀螺仪，挠性陀螺仪，激光陀螺仪等。 三自由度陀螺仪(具有内、外两个框架，使转子自转轴具有两个转动自由度。在没有任何力矩装置时，它就是一个自由陀螺仪)。 直流电流传感器 https://www.doczj.com/doc/3917046522.html,/subject/zhiliudianliuchuanganqi.html
系统组成如下： （1）动力系统（蓄电池组、直流无刷电机）； （2）传动系统（轮边减速器）： （3）行走系统（轮胎、前车架、后车架、摆动架）： （4）转向系统（电动推杆，铰接体）： （5）通信系统（车载无线AP、网络交换机、遥控装置接收器）； （6）信息采集系统（激光雷达、里程计、惯性导航模块、转角传感器）：（7）控制系统（主控制器、信号采集控制器、DSP电机驱动控制器）： （8）遥控系统（工业遥控器）动力系统由蓄电池组构成（24V蓄电池组2组，48V蓄电池组1组），作为整车的动力源以及控制电源。四轮独立驱动，动力分别由四个轮边电机经过轮边减速器传递到车轮。 行走系统由前后两个车架组成，车架由槽钢焊接，前后车架通过较接体与摆动架相连，可以实现车体的转向和摆动。 转向系统采用电动推杆（带有减速机构的直流无刷电机）代替转向油缸实现转向。 信息采集系统的构成与实车相同，包括激光雷达、里程计、转角传感器、惯性导航模块等，同样为了实现信息采集从而获取地面信息以及车体位姿信息。 通信系统的构成与实车相同，包括车载无线AP、网络交换机、遥控装置接收器，采用CAN总线和以太网通信，同样为了实现各个系统之间的数据交控制系统采用工控机以及信号采集控制器、DSP电机驱动控制器来实现模型样机的遥控操作以及无人驾驶。跟实车有所不同的是采用DSP电机驱动控制器取代了实车的执行控制器PLC，原因是DSP在对行驶驱动电机和转向电动推杆的控制上比执行控制器PLC更为方便。 1动力系统 地下铰接式自卸车实车采用柴油机作为动力源，而模型样机则采用蓄电池组作为动力源。 本文的研究目的是验证路径跟踪以及速度决策算法，作为研究对象的实车和模型样机均采用铰接转向与电传动结构，在运动关系上相同，所以动力源的不
基于运动规划的惯性导航系统动态实验 二零一三年六月十日
实验4.1 惯性导航系统运动轨迹规划与设计实验 一、实验目的 为进行动态下简化惯性导航算法的实验研究，进行路径和运动状态规划，以验证不同运动状态下惯导系统的性能。通过实验掌握步进电机控制方法，并产生不同运动路径和运动状态。 二、实验内容 学习利用6045B 控制板对步进电机进行控制的方法，并控制电机使运动滑轨产生定长运动和不同加速度下的定长运动。 三、实验系统组成 USB_PCL6045B 控制板（评估板）、运动滑轨和控制计算机组成。 四、实验原理 IMU安装误差系数的计算方法 USB_PCL6045B 控制板采用了USB 串行总线接口通信方式，不必拆卸计算机箱就可以在台式机或笔记本电脑上进行运动控制芯片PCL6045B 的学习和评估。 USB_PCL6045B 评估板采用USB 串行总线方式实现评估板同计算机的数据交换，由评估板的FIFO 控制回路完成步进电机以及伺服电机的高速脉冲控制，任意2 轴的圆弧插补，2-4 轴的直线插补等运动控制功能。USB_PCL6045B 评估板上配置了全部PCL6045B 芯片的外部信号接口和增量编码器信号输入接口。由 USB_PCL6045B 评估测试软件可以进行PCL6045B 芯片的主要功能的评估测试。
图4-1-1USB_PCL6045B 评估板原理框图 如图4-1-1 所示，CN11 接口主要用于外部电源连接，可以选择DC5V 单一电源或DC5V/24V 电源。CN12 接口是USB 信号接口，用于USB_PCL6045B 评估板同计算机的数据交换。 USB_PCL6045B 评估板已经完成对PCL6045B 芯片的底层程序开发和硬件资源与端口的驱动，并封装成156 个API 接口函数。用户可直接在VC 环境下利用API 接口函数进行编程。 五、实验内容 1、操作步骤 1）检查电机驱动电源（24V） 2）检查USB_PCL6045B 控制板与上位机及电机驱动器间的连接电缆 3）启动USB_PCL6045B 控制板评估测试系统检查系统是否正常工作。 4）运行编写的定长运动程序，并比较实际位移与设定位移。
陀螺仪是用来测量角速率的器件，在加速度功能基础上，可以进一步发展，构建陀螺仪。 陀螺仪的内部原理是这样的：对固定指施加电压，并交替改变电压，让一个质量块做振荡式来回运动，当旋转时，会产生科里奥利加速度，此时就可以对其进行测量；这有点类似于加速度计，解码方法大致相同，都会用到放大器。 角速率由科氏加速度测量结果决定 - 科氏加速度 = 2 × (w ×质量块速度) - w是施加的角速率(w = 2 πf) 通过14 kHz共振结构施加的速度（周期性运动）快速耦合到加速度计框架 - 科氏加速度与谐振器具有相同的频率和相位，因此可以抵消低速外部振动 该机械系统的结构与加速度计相似（微加工多晶硅） 信号调理（电压转换偏移）采用与加速度计类似的技术 施加变化的电压来回移动器件，此时器件只有水平运动没有垂直运动。如果施加旋转，可以看到器件会上下移动，外部指将感知该运动，从而就能拾取到与旋转相关的信号。
上面的动画，只是抽象展示了陀螺仪的工作原理，而真实的陀螺仪内部构造是下面这个样子。
PS：陀螺仪可以三个一起设计，分别对应于所谓滚动、俯仰和偏航。 任何了解航空器的人都知道，俯仰是指航空器的上下方向，偏航是指左右方向，滚动是指向左或向右翻滚。要正确控制任何类型的航空器或导弹，都需要知道这三个参数，这就会用到陀螺仪。它们还常常用于汽车导航，当汽车进入隧道而失去GPS信号时，这些器件会记录您的行踪。 无人机在飞行作业时，获取的无人机影像通常会携带配套的POS数据。从而在处理中可以更加方便的处理影像。而POS数据主要包括GPS数据和
IMU数据，即倾斜摄影测量中的外方位元素：（纬度、经度、高程、航向角（Phi）、俯仰角（Omega）及翻滚角（Kappa））。 GPS数据一般用X、Y、Z表示，代表了飞机在飞行中曝光点时刻的地理位置。 飞控是由主控MCU和惯性测量模块（IMU，Inertial Measurement Unit）组成。IMU提供飞行器在空间姿态的传感器原始数据，一般由陀螺仪传感器/加速度传感器/电子罗盘提供飞行器9DOF数据。 IMU中的传感器用来感知飞行器在空中的姿态和运动状态，这有个专有名词叫做运动感测追踪，英文Motion Tracking。运动感测技术主要有四种基础运动传感器，下面分别说明其进行运动感测追踪的原理。 微机电系统（MEMS） IMU中使用的传感器基本上都是微机电系统（MEMS），是半导体工业中非常重要的一个分支。 微机电系统（MEMS, Micro-Electro-Mechanical System）是一种先进的制造技术平台。微机电系统是微米大小的机械系统，是以半导体制造技术为基础发展起来的。 我们的四轴飞行器上用到的加速度陀螺仪MPU6050，电子罗盘 HMC5883L都是微机电系统，属于传感MEMS分支。传感MEMS技术是指用微电子微机械加工出来的、用敏感元件如电容、压电、压阻、热电耦、谐振、隧道电流等来感受转换电信号的器件和系统。 加速器（G-sensors） 加速器可用来感测线性加速度与倾斜角度，单一或多轴加速器可感应结合线性与重力加速度的幅度与方向。含加速器的产品，可提供有限的运动感测功能。 加速度计的低频特性好，可以测量低速的静态加速度。在我们的飞行器上，就是对重力加速度g（也就是前面说的静态加速度）的测量和分析，其它瞬间加速度可以忽略。记住这一点对姿态解算融合理解非常重要。 当我们把加速度计拿在手上随意转动时，我们看的是重力加速度在三个轴上的分量值。加速度计在自由落体时，其输出为0。为什么会这样呢？这里涉及到加速度计的设计原理：加速度计测量加速度是通过比力来测量，而不是通过加速度。
惯性导航基础课程大作业报告（一）光纤陀螺误差建模与分析 班级：111514 姓名： 学号 2014年5月26日
一.系统误差原理图 二.系统误差的分析 （一）漂移引起的系统误差 1. εx ，εy ，εz 对东向速度误差δVx 的影响 clc;clear all; t=1:0.01:25; g=9.8; L=pi/180*39; Ws=2*pi/84.4*60; Wie=2*pi/24; R=g/(Ws)^2; e=0.1*180/pi; mcVx1=e*g*sin(L)/(Ws^2-Wie^2)*(sin(Wie*t)-Wie*sin(Ws*t)/Ws); mcVx2=e*((Ws^2-(Wie^2)*((cos(L))^2))/(Ws^2-Wie^2)*cos(Ws*t)-(Ws^2)*((sin(L))^2)*cos(Wi e*t)/(Ws^2-Wie^2)-(cos(L))^2); mcVx3=(sin(L))*(cos(L))*R*e*((Ws^2)*cos(Wie*t)/(Ws^2-Wie^2)-(Wie^2)*cos(Ws*t)/(Ws^2-Wi e^2)-1); plot(t,[mcVx1',mcVx2',mcVx3']); title('Ex,Ey,Ez 对Vx 的影响'); xlabel('时间t'); ylabel('Vx(t)'); 0,δλδL ,v v δδ
legend('Ex-mcVx1','Ey-mcVx2','Ez-mcVx3'); grid; axis square; 分析：εx，εy，εz对东向速度误差δVx均有地球自转周期的影响，εx，εy还会有舒勒周期分量的影响，其中，εy对δVx的影响较大。 2.εx，εy，εz对东向速度误差δVy的影响 clc;clear all; t=1:0.01:25; g=9.8; L=pi/180*39; Ws=2*pi/84.4*60; Wie=2*pi/24; R=g/(Ws)^2; e=0.1*180/pi; mcVy1=e*g*(cos(Wie*t)-cos(Ws*t))/(Ws^2-Wie^2); mcVy2=g*sin(L)*e/(Ws^2-Wie^2)*(sin(Wie*t)-Wie/Ws*sin(Ws*t)); mcVy3=g*cos(L)*e/(Ws^2-Wie^2)*(sin(Wie*t)-Wie/Ws*sin(Ws*t)); plot(t,[mcVy1',mcVy2',mcVy3']); title('Ex,Ey,Ez对Vy的影响'); xlabel('时间t'); ylabel('Vy(t)'); legend('Ex-mcVy1','Ey-mcVy2','Ez-mcVy3'); grid; axis square;
陀螺仪介绍2013-1-28
?陀螺仪发展及应用情况 ?MEMS陀螺仪基本原理 ?陀螺仪与加速度传感器、电子罗盘的 对比以及九轴概念 ?测试讨论 2013-1-28
?陀螺仪发展及应用情况 ?MEMS陀螺仪基本原理 ?陀螺仪与加速度传感器、电子罗盘的 对比以及九轴概念 ?测试讨论 2013-1-28
2013-1-28 1850年法国的物理学家莱昂·傅科（J.Foucault ）为了研究地球自转，首先发现高速转动中的转子 （rotor ），由于惯性作用它的旋转轴永远指向一固定方向，他用希腊字 gyro （旋转）和skopein （看）两字合为gyro scopei 一字来命名这种仪表。
?最初的陀螺仪主要用于航海，起稳定船体的作用，此时主要是二维陀螺仪； ?后在航空、航天领域开始广泛的应用。用于飞行体运动的自动控制系统中，作为水平、垂直、俯仰、航向和角速度传感器。指示 陀螺仪主要用于飞行状态的指示，作为驾驶和领航仪表使用。在这些应用中都是三维陀螺仪； ?另外，在军事领域，陀螺仪也发挥着重要作用，例如炮弹的旋转、导弹的惯性导航系统，以提高击中－杀伤比 ?最开始用于航海、航空、航天的陀螺仪都是机械式的，到了现代，主要可以分为压电陀螺仪、微机械陀螺仪、光纤陀螺仪、激 光陀螺仪，现代陀螺仪在结构上已不具备“陀螺”，只是在功能上 与传统的机械陀螺仪同样罢了 2013-1-28
2013-1-28 现在广泛使用的MEMS （微机械）陀螺可应用于航空、航天、航海、兵器、汽车、生物医学、环境监控等领域。并且MEMS 陀螺相比传统的陀螺有明显的优势： 1、体积小、重量轻，适合于对安装空间和重量要求苛刻的场合，例如弹载测量等； 2、低成本； 3、更高可靠性，内部无转动部件，全固
最优估计大作业 姓名：李海宝 学号：S314040186 导师：刘胜 专业：控制科学与工程
模糊逻辑卡尔曼滤波器在智能AUV导航系统中的自适应调 整 摘要 本论文基于全球定位系统（GPS）和几个惯性导航系统（INS）传感器描述了对于自主水下航行器（AUV）应用的一种智能导航系统的执行过程。本论文建议将简单卡尔曼滤波器（SKF）和扩展卡尔曼滤波器（EKF）一前一后地用于融合INS 传感器的数据并将它们与GPS数据结合到一起。传感器噪声特性里潜在的变化会引起SKF和EKF的初始统计假定的调整，本论文针对这一问题着重突出了模糊逻辑方法的使用。当这种算法包含实际传感器噪特性的时候，SKF和EKF只能维持他们的稳定性和性能，因此我们认为这种自适应机制同SKF与EKF一样有必要。此外，在提高导航系统的可靠性融合过程期间，故障检测和信号恢复算法也需在此要讨论。本论文建议的这种算法用于使真实的实验数据生效，这些数据都是从Plymouth大学和Cranfield大学所做的一系列AUV实验(运行低成本的锤头式AUV)中获得的。 关键词：自主水下航行器；导航；传感器融合；卡尔曼滤波器；扩展卡尔曼滤波器；模糊逻辑 1.引言 对于以科学、军事、商业为目的应用，如海洋勘察、搜索未爆弹药和电缆跟踪检查，AUV的发展需要相应导航系统的发展。这样的系统提供航行器位置和姿态的数据是很有必要的。在这样的系统中对精度的要求是最重要的：错误的位置和姿态数据会导致收集数据的一个毫无意义的解释，或者甚至AUV的一个灾难性故障。 越来越多来自整个世界的研究团队正利用INS和GPS来研发组合导航系统。然而，他们的工作中几乎都没有明确几个INS传感器融合的本质要求，这些传感器用于确保用户保持精度或甚至用来防止在与GPS融合之前导航系统这部分的完全失败。例如，金赛和惠特科姆（2003）使用一个切换机制来防止INS的完全失败。虽然这个方法简单易行，但是可能不适合用于维持一个确定的精度等级。 出于多传感器数据融合和集成的目的，几种估计方法在过去就已经被使用过。为此，SKF/EKF和它们的变形在过去就已经是流行的方法，并且一直到现在都对开发算法感兴趣。然而，在设计SKF/EKF过程中，一个显著的困难经常会被
陀螺仪工作原理与应用（陀螺经纬仪Jyro Station） 来源：译自日本《测量》06年8月号作者：日本测量仪器工业会更新日期：2006-9-22 阅读次数：3235 为了求得测量的基准方位和日照时间的方位，必须使用磁针罗盘仪进行天体观测。然而，磁针罗盘仪的精度有限，在天体观测中还要受到确保通视、天气、场所和时间等观测条件的影响。为了解决这些问题，可采用利用了力学原理求得真北的陀螺经纬仪。陀螺经纬仪在隧道测量以及由于不能和已知点通视而无法确定方位、方向角的情况下都能发挥很大的作用。 （图1：陀螺工作站） 1、陀螺工作站的原理 高速旋转的物体的旋转轴，对于改变其方向的外力作用有趋向于铅直方向的倾向。而且，旋转物体在横向倾斜时，重力会向增加倾斜的方向作用，而轴则向垂直方向运动，就产生了摇头的
运动（岁差运动）。当陀螺经纬仪的陀螺旋转轴以水平轴旋转时，由于地球的旋转而受到铅直方向旋转力，陀螺的旋转体向水平面内的子午线方向产生岁差运动。当轴平行于子午线而静止 时可加以应用。 2、陀螺工作站的构造 （图4：陀螺经纬仪的构造 0点调整螺丝，吊线，照明灯，陀螺转子、指针、供电用馈线、反 射镜、陀螺马达、刻度线、目镜）。
陀螺经纬仪的陀螺装置由陀螺部分和电源部分组成。此陀螺装置与全站仪结合而成。陀螺本体在装置内用丝线吊起使旋转轴处于水平。当陀螺旋转时，由于地球的自转，旋转轴在水平面内以真北为中心产生缓慢的岁差运动。旋转轴的方向由装置外的目镜可以进行观测，陀螺指针的振动中心方向指向真北。利用陀螺经纬仪的真北测定方法有“追尾测定”和“时间测定”等。 追尾测定[反转法] 利用全站仪的水平微动螺丝对陀螺经纬仪显示岁差运动的刻度盘进行追尾。在震动方向反转的点上（此时运动停止）读取水平角。如此继续测定之，求得其平均震动的中心角。用此方法进行20分钟的观测可以求得+/-0。5分的真北方向。 时间测定[通过法] 用追尾测定观测真北方向后，陀螺经纬仪指向了真北方向，其指针由于岁差运动而左右摆动。用全站仪的水平微动螺丝对指针的摆动进行追尾，当指针通过0点时反复记录水平角，可以提高时间测定的精度，并以+/-20秒的精度求得真北方向。 （图2：摇头运动） （图3：向子午线的岁差运动）
陀螺仪的工作原理 陀螺仪的原理 一个旋转物体的旋转轴所指的方向在不受外力影响时，是不会改变的。人们根据这个道理，用它来保持方向，制造出来的东西就叫陀螺仪。我们骑自行车其实也是利用了这个原理。轮子转得越快越不容易倒，因为车轴有一股保持水平的力量。陀螺仪在工作时要给它一个力，使它快速旋转起来，一般能达到每分钟几十万转，可以工作很长时间。然后用多种方法读取轴所指示的方向，并自动将数据信号传给控制系统。 现代陀螺仪 一种能够精确地确定运动物体的方位的仪器，它是现代航空，航海，航天和国防工业中广泛使用的一种惯性导航仪器，它的发展对一个国家的工业，国防和其它高科技的发展具有十分重要的战略意义。传统的惯性陀螺仪主要是指机械式的陀螺仪，机械式的陀螺仪对工艺结构的要求很高，结构复杂，它的精度受到了很多方面的制约。自从上个世纪七十年代以来，现代陀螺仪的发展已经进入了一个全新的阶段。1976年等提出了现代光纤陀螺仪的基本设想，到八十年代以后，现代光纤陀螺仪就得到了非常迅速的发展，与此同时激光谐振陀螺仪也有了很大的发展。由于光纤陀螺仪具有结构紧凑，灵敏度高，工作可靠等等优点，所以目前光纤陀螺仪在很多的领域已经完全取代了机械式的传统的陀螺仪，成为现代导航仪器中的关键部件。和光纤陀螺仪同时发展的除了环式激光陀螺仪外，还有现代集成式的振动陀螺仪，集成式的振动陀螺仪具有更高的集成度，体积更小，也是现代陀螺仪的一个重要的发展方向。 现代光纤陀螺仪 包括干涉式陀螺仪和谐振式陀螺仪两种，它们都是根据塞格尼克的理论发展起来的。塞格尼克理论的要点是这样的：当光束在一个环形的通道中前进时，如果环形通道本身具有一个转动速度，那么光线沿着通道转动的方向前进所需要的时间要比沿着这个通道转动相反的方向前进所需要的时间要多。也就是说当光学环路转动时，在不同的前进方向上，光学环路的光程相对于环路在静止时的光程都会产生变化。利用这种光程的变化，如果使不同方向上前进的光之间产生干涉来测量环路的转动速度，这样就可以制造出干涉式光纤陀螺仪，如果利用这种环路光程的变化来实现在环路中不断循环的光之间的干涉，也就是通过调整光纤环路的光的谐振频率进而测量环路的转动速度，就可以制造出谐振式的光纤陀螺仪。从这个简单的介绍可以看出，干涉式陀螺仪在实现干涉时的光程差小，所以它所要求的光源可以有较大的频谱宽度，而谐振式的陀螺仪在实现干涉时，它的光程差较大，所以它所要求的光源必须有很好的单色性。 陀螺仪工作原理与应用（陀螺经纬仪Jyro Station） 来源：译自日本《测量》06年8月号作者：日本测量仪器工业会更新日期：2006-9-22 阅读次数：6183
基于运动规划的惯性导航系统动态实验 GAGGAGAGGAFFFFAFAF
二零一三年六月十日 实验4.1 惯性导航系统运动轨迹规划与设计实验一、实验目的 为进行动态下简化惯性导航算法的实验研究，进行路径和运动状态规划，以验证不同运动状态下惯导系统的性能。通过实验掌握步进电机控制方法，并产生不同运动路径和运动状态。 二、实验内容 学习利用6045B 控制板对步进电机进行控制的方法，并控制电机使运动滑轨产生定长运动和不同加速度下的定长运动。 三、实验系统组成 USB_PCL6045B 控制板（评估板）、运动滑轨和控制计算机组成。 四、实验原理 IMU安装误差系数的计算方法 GAGGAGAGGAFFFFAFAF
USB_PCL6045B 控制板采用了USB 串行总线接口通信方式，不必拆卸计算机箱就可以在台式机或笔记本电脑上进行运动控制芯片PCL6045B 的学习和评估。 USB_PCL6045B 评估板采用USB 串行总线方式实现评估板同计算机的数据交换，由评估板的FIFO 控制回路完成步进电机以及伺服电机的高速脉冲控制，任意 2 轴的圆弧插补，2-4 轴的直线插补等运动控制功能。USB_PCL6045B 评估板上配置了全部PCL6045B 芯片的外部信号接口和增量编码器信号输入接口。由 USB_PCL6045B 评估测试软件可以进行PCL6045B 芯片的主要功能的评估测试。 GAGGAGAGGAFFFFAFAF
图4-1-1USB_PCL6045B 评估板原理框图如图4-1-1 所示，CN11 接口主要用于外部电源连接，可以选择DC5V 单一电源或DC5V/24V 电源。CN12 接口是USB 信号接口，用于USB_PCL6045B 评估板同计算机的数据交换。 USB_PCL6045B 评估板已经完成对PCL6045B 芯片的底层程序开发和硬件资源与端口的驱动，并封装成156 个API 接口函数。用户可直接在VC 环境下利用API 接口函数进行编程。 五、实验内容 GAGGAGAGGAFFFFAFAF
哈工大导航原理大作业-标准化文件发布号：（9456-EUATWK-MWUB-WUNN-INNUL-DDQTY-KII
《导航原理》作业 (惯性导航部分)
一、题目要求 A fighter equipped with SINS is initially at the position of ?35 NL and ?122 EL,stationary on a motionless carrier. Three gyros X G ,Y G ,Z G ,and three accelerometers, X A ,Y A ,Z A are installed along the axes b X ,b Y ,b Z of the body frame respectively. Case 1:stationary onboard test The body frame of the fighter initially coincides with the geographical frame, as shown in the figure, with its pitching axis b X pointing to the east,rolling axis b Y to the north, and azimuth axis b Z upward. Then the body of the fighter is made to rotate step by step relative to the geographical frame. (1) ?10around b X (2) ?30around b Y (3) ?50-around b Z After that, the body of the fighter stops rotating. You are required to compute the final output of the three accelerometers on the fighter, using both DCM and quaternion respectively,and ignoring the device errors. It is known that the magnitude of gravity acceleration is 2/8.9g s m =. Case 2:flight navigation Initially, the fighter is stationary on the motionless carrier with its board 25m above the sea level. Its pitching and rolling axes are both in the local horizon, and its rolling axis is ?45on the north by east, parallel with the runway onboard. Then the fighter accelerate along the runway and take off from the carrier. The output of the gyros and accelerometers are both pulse numbers,Each gyro pulse is an angular increment of sec arc 1.0-,and each accelerometer pulse is g 6e 1-,with 2/8.9g s m =.The gyro output frequency is 10 Hz,and the accelerometer ’s is 1Hz. The output of gyros and accelerometers within 5400s are stored in MATLAB data files named gout.mat and aout.mat, containing matrices gm of 35400? and am of 35400? respectively. The format of data as shown in the tables, with 10 rows of each matrix selected. Each row represents the out of the type of sensors at each sample time.
实 验一 陀螺仪关键参数测试与分析实验 加速度计关键参数测试与分析实验 二零一三年五月十二日 实验一陀螺仪关键参数测试与分析实验 一、实验目得 通过在速率转台上得测试实验,增强动手能力与对惯性测试设备得感性认识；通过对陀螺仪测试数据得分析,对陀螺漂移等参数得物理意义有清晰得认识,同时为在实际工程中应用陀螺仪与对陀螺仪进行误差建模与补偿奠定基础。 二、实验内容 利用单轴速率转台,进行陀螺仪标度因数测试、零偏测试、零偏重复性测试、零漂测试实验与陀螺仪标度因数与零偏建模、误差补偿实验。 三、实验系统组成 单轴速率转台、MEMS 陀螺仪(或光纤陀螺仪)、稳压电源、数据采集系统与分析系统。
四、实验原理 1.陀螺仪原理 陀螺仪就是角速率传感器,用来测量载体相对惯性空间得角速度，通常输出与角速率对应得电压信号。也有得陀螺输出频率信号(如激光陀螺）与数字信号（把模拟电压数字化)。以电压表示得陀螺输出信号可表示为: (1-1）式中就是与比力有关得陀螺输出误差项，反映了陀螺输出受比力得影响,本实验不考虑此项误差。因此，式（１－１）简化为 (１-2）由（１－2）式得陀螺输出值所对应得角速度测量值: (1－3) 对于数字输出得陀螺仪,传感器内部已经利用标度因数对陀螺仪模拟输出进行了量化,直接输出角速度值,即： （１－4）就是就是陀螺仪得零偏，物理意义就是输入角速度为零时，陀螺仪输出值所对应得角速度。且 (１-5) 精度受陀螺仪标度因数、随机漂移、陀螺输出信号得检测精度与得影响。通常与表现为有规律性,可通过建模与补偿方法消除,表现为随机特性,可通过信号滤波方法抵制。因此，准确标定与就是实现角速度准确测量得基础。 五、陀螺仪测试实验步骤 1)标度因数与零偏测试实验 ａ、接通电源，预热一定时间; b、陀螺工作稳定后，测量静止情况下陀螺输出并保存数据;
波音737—800飞机飞行模型建立实验 学院：航空自动化 专业：导航制导与控制
1 实验目的 根据飞机所提供的QAR数据，把飞机的飞行过程分为几个阶段，通过受力分析计算得出飞机在各阶段的各个时刻的地速以及飞机当时所处的地球经纬度。这之后，再把计算出来的这些数据与QAR里面的相对应的数据进行比较，得出数据误差。使我们对飞机各阶段的机体受力分析得到验证，最后确定飞机的整个飞行过程的模型。 2 实验内容 分析所得的QAR数据，根据QAR数据对飞机的飞行过程进行分阶段处理。然后查找相关资料，对飞机在飞行各阶段过程中进行受力分析。进而用MATLAB软件编写程序，计算出飞机各个阶段的地速和地球经纬度。最后把计算出来的数据和QAR里相应的数据作比较，用MA TLAB画出比较曲线图，得出计算误差，建立起飞机的飞行过程模型。在整个实验过程中要修学的课程有：《大气数据应用分析》、《导航原理与系统》、《飞机的飞行性能》、《惯性导航原理》、《MATLAB应用与编程》等等。
3 实验步骤 3.1 QAR数据分析 QAR数据分析 数据英文数据意义和用途所用仪表备注 1 东经Present Position Longitude 由0°本初子午线向东、西递增到180°导航仪 2 北纬Present Position Latitude 赤道向北递增到90°导航仪 3 磁航向Heading Magnetic 飞机纵轴在地平面上的投影，与磁子午线的 夹角（磁北顺时针转的夹角）。磁偏角：地 球表面任一点的磁子午圈同地理子午圈的夹 角。 磁罗盘上 有罗差修 正器，已经 抵消罗差， 所以磁罗 盘测的基 本就是磁 航向。 4 标准气压高度ALTITUDE 飞机到标准气压平面的垂直距离气压式高度表 5 左无线电高度RADIO HEIGHT Left 飞机到地面的垂直距离 无线电高 度表 6 机场标高AIR/GROUND 机场与海平面的垂直高度 7 左主起落架Left main gear air/end 起落架用于在地面停放及滑行时支撑飞机并 使飞机在地面上灵活运动，并吸收飞机运动 时产生的撞击载荷。主要用来判断飞机是否 起飞。 8 右主起落架Right main gear air/end 9 真空速Computed airspeed 飞机相对于空气的运动速度，根据空速可计 算地速，从而确定已飞距离和待飞时间。 空速表0.5~1.0 10 马赫数MACH 真空速与飞机所在高度的音速之比，当飞机 的M数超过临界M数时，飞机的空气动力特 马赫数表0.5~1.0
一文读懂三轴陀螺仪工作原理和应用 Iphone 4手机采用了意法半导体的MEMS（微电机系统）陀螺仪芯片，芯片内部包含有一块微型磁性体，可以在手机进行旋转运动时产生的科里奥力作用下向X，Y，Z三个方向发生位移，利用这个原理便可以测出手机的运动方向。而芯片核心中的另外一部分则可以将有关的传感 一、三轴陀螺仪工作原理三轴陀螺仪：同时测定6个方向的位置，移动轨迹，加速。单轴的只能测量一个方向的量，也就是一个系统需要三个陀螺仪，而3轴的一个就能替代三个单轴的。3轴的体积小、重量轻、结构简单、可靠性好，是激光陀螺的发展趋势。 在最新款的iPhone 4手机中内置三轴陀螺仪，它可以与加速器和指南针一起工作，可以实现6轴方向感应，三轴陀螺仪更多的用途会体现在GPS和游戏效果上。一般来说，使用三轴陀螺仪后，导航软件就可以加入精准的速度显示，对于现有的GPS导航来说是个强大的冲击，同时游戏方面的重力感应特性更加强悍和直观，游戏效果将大大提升。这个功能可以让手机在进入隧道丢失GPS信号的时候，凭借陀螺仪感知的加速度方向和大小继续为用户导航。而三轴陀螺仪将会与iPhone原有的距离感应器、光线感应器、方向感应器结合起来让iPhone 4的人机交互功能达到了一个新的高度。 二、三轴陀螺仪的应用在工程上，陀螺仪是一种能够精确地确定运动物体的方位的仪器，它是现代航空，航海，航天和国防工业中广泛使用的一种惯性导航仪器，它的发展对一个国家的工业，国防和其它高科技的发展具有十分重要的战略意义。传统的惯性陀螺仪主要是指机械式的陀螺仪，机械式的陀螺仪对工艺结构的要求很高，结构复杂，它的精度受到了很多方面的制约。自从上个世纪七十年代以来，现代陀螺仪的发展已经进入了一个全新的阶段。1976年美国Utah大学的Vali和Shorthill提出了现代光纤陀螺仪的基本设想，到八十年代以后，现代光纤陀螺仪就得到了非常迅速的发展，与此同时激光谐振陀螺仪也有了很大的发展。由于光纤陀螺仪具有结构紧凑，灵敏度高，工作可靠等等优点，所以目前光纤陀螺仪在很多的领域已经完全取代了机械式的传统的陀螺仪，成为现代导航仪器中的
(完整)北航惯性导航作业二. 编辑整理： 尊敬的读者朋友们： 这里是精品文档编辑中心，本文档内容是由我和我的同事精心编辑整理后发布的，发布之前我们对文中内容进行仔细校对，但是难免会有疏漏的地方，但是任然希望（(完整)北航惯性导航作业二.）的内容能够给您的工作和学习带来便利。同时也真诚的希望收到您的建议和反馈，这将是我们进步的源泉，前进的动力。 本文可编辑可修改，如果觉得对您有帮助请收藏以便随时查阅，最后祝您生活愉快业绩进步，以下为(完整)北航惯性导航作业二.的全部内容。
惯性导航作业
一、数据说明： 1：惯导系统为指北方位的捷连系统.初始经度为116。344695283度、纬度为 39.975172度,高度h为30米。初速度v0=［—9。993908270;0.000000000； 0.348994967］。 2：jlfw中为600秒的数据，陀螺仪和加速度计采样周期分别为为1/100秒和1/100秒。 3：初始姿态角为［2 1 90］（俯仰，横滚，航向,单位为度)，jlfw。mat中保存的 为比力信息f_INSc(单位m/s^2)、陀螺仪角速率信息wib_INSc(单位rad/s)，排列 顺序为一～三行分别为X、Y、Z向信息. 4：航向角以逆时针为正. 5：地球椭球长半径re=6378245;地球自转角速度wie=7。292115147e-5;重力加速度 g=g0*（1+gk1＊c33^2)＊（1-2*h/re)/sqrt(1—gk2*c33^2）;g0=9.7803267714； gk1=0。00193185138639；gk2=0。00669437999013；c33=sin（lat纬度）; 二、作业要求： 1:可使用 MATLAB语言编程，用MATLAB编程时可使用如下形式的语句读取数据： load D:\..。文件路径。。.\jlfw,便可得到比力信息和陀螺仪角速率信息。用角增 量法。 2:（1) 以系统经度为横轴,纬度为纵轴（单位均要转换为：度）做出系统位置曲线图； （2）做出系统东向速度和北向速度随时间变化曲线图（速度单位:m/s，时间单位:s)； (3) 分别做出系统姿态角随时间变化曲线图（俯仰，横滚,航向,单位转换为：度，时间单位：s)； 以上结果均要附在作业报告中. 3：在作业报告中要写出“程序流程图、现阶段学习小结”,写明联系方式。 （注意程序流程图不是课本上的惯导解算流程，而是你程序分为哪几个模块、是 怎样一步步执行的,什么位置循环等，让别人根据该流程图能够编出相应程序）