毕业设计（论文）-角速度陀螺信号测量及标定方法研究.doc

《毕业设计（论文）-角速度陀螺信号测量及标定方法研究.doc》由会员分享，可在线阅读，更多相关《毕业设计（论文）-角速度陀螺信号测量及标定方法研究.doc（32页珍藏版）》请在三一文库上搜索。

1、中北大学信息商务学院2011届毕业设计说明书1 绪论1.1 引言1.1.1 硅微机械陀螺仪的背景微机械陀螺仪是基于微机械加工制造技术产生的高技术产品，是当代微机械电子系统（MEMS）领域和惯性领域新兴的重要的分支，而MEMS及其制造技术是在微电子工艺的基础上发展起来的 的前沿研究领域，它涉及到电子工程、机械工程、材料科学、物理学、化学以及生物医学等多种工程技术和学科。它是未来低成本、高精度、微尺寸、低功耗、抗高过载、高可靠性惯性测量原件的发展方向。它不仅用于武器装备的惯性导航系统和姿态测量系统等军事领域，同时还可以用于 、飞机、汽车、工业机器人、摄影、玩具、医疗器械的方向定位和姿态测量等民用商

2、业领域。开展这一领域的研究工作，可以加速和促进我国对新型惯性测量原件的应用，这在高技术日益发展的今天有十分重要的研究意义。用微机电系统惯性制导和控制代替常规系统，特别是与GPS集合使用时，可提供精确度。针对这一背景，对硅微机械陀螺的研究具有深远的战略意义1。1.1.2 硅微机械陀螺仪的现状微机械陀螺是21世纪微纳米高科技领域中为电子系统（MEMS）最具有代表性的惯性期间，世界许多国家都在开展积极研发。硅材料结构完整、弹性好、比较容易得到高Q值（Q值是衡量电感器件的主要参数，是指电感器在某一频率的交流电压下工作时，所呈现的感抗与其等效损耗电阻之比，电感器的Q值越高，其损耗越小，效率越高， 电感器

3、品质因数的高低与线圈导线的直流电阻、线圈骨架的介质损耗及铁心、屏蔽罩等引起的损耗等有关）的微机械结构，随着深反应离子刻蚀技术的出现，体硅微机械加工技术的加工精度明显提高，在硅衬底上用多品硅制作期间适宜批量生产、驱动和检测较为方便，成为当前低成本研发的主流2。1988年，美国Draper lab实验室研制出第一台框架式角振动微机电陀螺仪，1933年又研制出性能更佳的音叉式线振动陀螺仪，其引起世界各国的高度重视，纷纷投入财力物力开发研究。俄国莫斯科Vector Ltd正在研制精密的微机械陀螺，已经论证和仿真实验。英国Newscast大学和Durham大学合作，研究出了 振动模式硅微机械陀螺。经过十

4、多年的努力，目前在技术上已经取得巨大进展，正在向中、高精度发展。硅微机械陀螺的结构常用的有振梁结构、双框架结构、平面对称结构、横向音叉结构、梳妆音叉结构、梁岛结构等，驱动方式有静电驱动，压电驱动和电磁驱动等，检测方式有电容检测、压电检测、压阻检测。静电驱动、 检测的陀螺设计较为常见，美国ADI公司已研制出了单片集成的梳妆静电驱动、叉指式电容检测的硅微机械陀螺ADXRS系列，该脱落可用于集成GPS系统的惯性测量组合3。微机电陀螺是近年来出现的新技术，它是随着陀螺技术的发展趋势。随着微机械加工技术的发展，惯性仪表的各方面性能将迅速大幅度提高，并将在更广泛的领域内代替传统的惯性仪表。我国起步比较晚，

5、目前在清华大学、北京大学、复旦大学、东南大学、中国科技大学、中北大学等高校，以及中科院、航天部、信息产业部等研究单位均开展通用硅微机械陀螺的研制，已在理论和加工工艺上取得巨大成果。10多年来研究队伍逐渐扩大，本世纪初已形成40多个单位的50多个研究小组，在硅微机械方面开展了大量的研究工作，取得了长足的发展。目前世界各国研制的硅微机械陀螺主要是有驱动结构的通用硅微机械 ，无驱动结构的旋转弹用硅微机械陀螺国外只有俄国在研究，目前有一维硅陀螺原型机，我国有两维硅陀螺原型机4。1.1.3 本课题研究的方法与步骤（1）学习并分析角速度陀螺信号采集原理；（2）学习并设计角速度陀螺调理电路，研究角速度陀螺信

6、号的测量及标定方法；（3）利用PROTEL软件，研究角速度陀螺信号的测量及标定方法；（4）综上给出测量及标定方法；（5）完成电路设计，实现硬件功能；2 角速度陀螺仪信号采集原理及标定方法2.1引言2.1.1 陀螺仪的结构陀螺仪的装置，一直是航空和航海上航行姿态及速率等最方便实用的参考仪表。从力学的观点近似的分析陀螺的运动时，可以把它看成是一个刚体，刚体上有一个万向支点，而陀螺可以绕着这个支点作三个自由度的转动，所以陀螺的运动是属于刚体绕一个定点的转动运动。更确切地说，一个绕对称铀高速旋转的飞轮转子叫陀螺。将陀螺安装在框架装置上，使陀螺的自转轴有角转动的自由度，这种装置的总体叫做陀螺仪5，陀螺仪

7、的基本部件有：(1) 陀螺转子(常采用同步电机、磁滞电机、三相交流电机等拖动方法来使陀螺转子绕自转轴高速旋转，并见其转速近似为常值);(2) 内、外框架(或称内、外环，它是使陀螺自转轴获得所需角转动自由度的结构);(3) 附件(是指力矩马达、信号传感器等) 。陀螺仪的两个基本特性：一为定轴性，另一个是进动性，它们都建立在角动量守恒的原则下6。定轴性:当陀螺转子以高速旋转时，若没有任何外力矩作用在陀螺仪上时，陀螺仪的自转轴在惯性空间中的指向保持稳定不变，即指向一个固定方向；同时反抗任何改变转子轴向的力量。这称为陀螺仪的定轴性或稳定性。其稳定性随以下的物理量而改变：1、转子的转动惯量愈大，稳定性愈

8、好；2、转子角速度愈大，稳定性愈好。所谓“转动惯量”，是描述刚体在转动中惯性大小的物理量。当以相同的力矩分别作用在两个绕定轴转动的不同刚体上，它们所获得的角速度通常是不一样的，转动惯量大的刚体所获得的角速度小，也就是保持原有转动状态的惯性大；反之，转动惯量小的刚体所获得的角速度大，也就是保持原有转动状态的惯性小。进动性:当转子高速旋转时,若外力矩作用于外环轴，陀螺仪将绕内环轴转动；若外力矩作用于内环轴，陀螺仪将绕外环轴转动。其转动角速度方向与外力矩作用方向互相垂直。这种特性，叫做陀螺仪的进动性。进动角速度的方向取决于动量矩H的方向(与转子自转角速度矢量的方向一致)和外力矩M的方向，而且是自转角

9、速度矢量以最短的路径追赶外力矩。这可以通过右手定则来判定。即伸直右手，大拇指与食指垂直，手指顺着自转轴的方向，手掌朝外力矩的正方向，然后手掌与4指弯曲握拳，则大拇指的方向就是进动角速度的方向。进动角速度的大小取决于外力矩M的大小和转子动量矩H的大小,其计算式为 =M/H。进动性的大小也有三个影响的因素：1、外界作用力愈大，其进动角速度也愈大；2、转子的转动惯量愈大，进动角速度愈小；3、转子的角速度愈大，进动角速度愈小。2.1.2 陀螺仪的主要参数电源（V）：这个参数规定了陀螺仪正常工作所需的直流电源电压范围；电源电流(mA)：这个参数规定了陀螺仪正常工作所消耗的电流大小；睡眠模式电源电流 (m

10、A):这个参数规定了陀螺仪在睡眠模式下所消耗电流；关机模式下的电源电流(A):该参数规定了陀螺仪电源关闭时所消耗电流；全量程(dps):这个参数规定了陀螺仪的量程范围；零速率输出值(电压或最低效位):这个参数规定了当陀螺仪没有被施加角速率时的零速率输出信号的数值；灵敏度(mV/dps或dps/LSB):这个参数规定了在零速率输出值时1dps与模拟陀螺仪输出电压变化的关系，用mV/dps表示；数字陀螺仪的灵敏度(dps/LSB)表示1个最低有效位与dps的关系；灵敏度变化与温度关系(%/C):这个参数规定了当温度偏离25室温时，以为单位的灵敏度百分比变化；零速率输出值变化与温度关系(dps/):

11、这个参数规定了当温度偏离25室温时，以为单位的零速率输出值的变化；非线性(%FS):这个参数规定了陀螺仪输出与最佳匹配直线之间的最大误差占全量程(FS) 的百分比；系统带宽(Hz):这个参数规定了角速率信号频率范围：从直流到模拟陀螺仪可测量的内部带宽（BW）；速率噪声密度(dps/Hz)：这个参数规定了能够从陀螺仪输出以及BW参数获得的模拟陀螺仪和数字陀螺仪的标准分辨率；自测 (mV or dps):这个功能可用于测试陀螺仪工作是否正常。这个功能的好处是在陀螺仪安装到印刷电路板后无需旋转印刷电路板即可测试陀螺仪7。2.1.3 微机械陀螺仪的工作原理微机械陀螺仪利用了哥氏力现象8，其原理如图2.

12、1所示。当图中的物体沿X轴做周期性振动或其他运动时，并且XY坐标系沿Z轴做角速度为z旋转运动，就会在该物体上产生一个沿Y轴方向的哥氏力。 图2.1 哥氏力现象2.1.4 陀螺仪校准陀螺仪在出厂前都经过严格的性能测试以及灵敏度和零速率输出值校准9。不过，当陀螺仪组装到印刷电路板后，因为机械或电焊应力的影响，零速率输出值和灵敏度可能会略微偏离工厂校准调试值。对于游戏机和遥控器等应用，设计人员只要用数据表中的典型零速率和灵敏度参数，即可把陀螺仪的测量信号转换成角速率。对于要求严格的应用，设计人员需要重新校准陀螺仪的零速率输出值、灵敏度和以下重要参数:（1）失准 (又称跨轴灵敏度)；（2）线性加速度灵

13、敏度或g-灵敏度；（3）长期运行偏差稳定性；（4）导通-导通偏差稳定性；（5）长时间工作后偏差和灵敏度漂移。为修正导通-导通偏差不稳定性，在陀螺仪上电后，用户可以采集50100个输出数据样本，取这些样本的平均值作导通零速率输出值R0 ，假设该陀螺仪是静止状态。因为温度变化和测量噪声，当陀螺仪是静止状态时，陀螺仪的每次读数可能略有不同。设定一个阈值 Rth ，如果陀螺仪测量值的绝对值小于阈值，则使陀螺仪的读数归零。这个方法将消除零速率噪声，当陀螺仪静止时，角位移不会累加。 每当陀螺仪静止时，用户可以采集50100个陀螺仪数据，然后取这些样本的平均值作为零速率输出值R0。这个方法可以消除零速率运行

14、偏差和微小温度变化。 在零速率采样后，必须从上面的几步开始考虑不稳定性因此。应该强调的是，MEMS陀螺仪的灵敏度非常稳定，受工作时间和环境温度的影响很小，仅上面提到的高灵敏度应用才需要校准过程。使用角速率测量台确定灵敏度，因为陀螺仪能够直接测量角速率，所以角速率测量台是校准陀螺仪灵敏度的最佳参考标准。在一个精确角速率测量台内有一个内嵌温度单元。为了确保在校准陀螺仪过程中角速率测量台不受环境振动的影响，角速率测量台被置于一个振动隔离平台之上。 把手持设备置于一个正方体的铝盒或塑料盒内，然后把整个系统安装在角速率测量台上进行校准。使角速率测量台沿顺时针和逆时针两个不同方向旋转。如果被校准的是多轴陀

15、螺仪，把方正形测试盒置于角速率测量台上的不同方位，然后重复上面的校准过程。收集完陀螺仪在不同状况下的原始数据后，即可确定零速率输出值、灵敏度、失准矩阵和g灵敏度值。 校准陀螺仪还可以选用步进电机旋转测量台，用一台个人电脑控制步进电机旋转测量台。使用数字罗盘确定灵敏度，如果没有角速率测量台，可以使用数字罗盘代替角速率测量台。在校准陀螺仪前，需要校准数字罗盘的倾斜度，然后将其置于周围没有干扰磁场的平台上。2.2 信号的采集与标定单晶硅摆仪角速度旋转时，偏转角的变化将导致单晶硅摆和玻璃电极极板构成的四个电容C1、C2、C3、C4发生变化。将电容变化信号转换成电压信号之后放大，即可得到幅值与被测角速度

16、对应的电压信号10。旋转载体用硅微机械陀螺的电容变化率较小，容易受分布电容的，因此，信号测量采用交流电桥作借口的变换电路，将电容式敏感原件作交流电容电桥的工作臂，电桥供电电源为等幅高频稳定交流电压。工作电容变化时，在电桥输出端可获得受工作电容变化调制的调幅信号输出，调幅信号经放大、解调后，获得低频信号输出 。图2.2 硅微机械信号测量电路原理图2.2.1 信号的处理硅微机械陀螺的电容变化率较小，容易受分布电容的，因此，信号测量采用交流电桥作借口的变换电路，将电容式敏感原件作交流电容电桥的工作臂，电桥供电电源为等幅高频稳定交流电压。工作电容变化时，在电桥输出端可获得受工作电容变化调制的调幅信号输

17、出，调幅信号经放大、解调后，获得低频信号输出，最后还要进行电路上的相位补偿，补偿由电路引起的相位误差。信号放大部分采用的是差分放大的方法。带通滤波主要完成直流信号的隔离和高频载波的滤除，取出还有姿态信息的有用信号11。从传感器及其特征噪声、阻抗、响应和信号幅度入手，实现最低的折合到输入端(RTI)噪声将能够优化信噪比(SNR)。先解决增益和功耗需求、然后再努力应对噪声问题的方法相比，围绕着低噪声来解决问题将更加有效。这是一个重复的过程，首先考虑放大器的工作区：宽带或1/f。接着，挑选合适的有源器件，设计最佳的噪声特性。在放大器周围放置无源器件，并限制带宽。然后分析非噪声需求，如输入阻抗、电源电

18、流和开环增益。如果没有达到噪声指标，则重复这一过程，直到获得可以接受的解决方案为止12。信号处理的步骤如下：1运算放大器的选择 在一些情况下，宽带噪声为22nV /dB的运算放大器可能优于宽带噪声为10nV/dB的器件。如果传感器工作在极低的频率下，那么，具有低1/f噪声的放大器可能是最好的。ADI公司的OP177等标准放大器的噪声频谱密度类曲线。自稳零放大器能连续校准输入端随时间和温度的变化而出现的任意误差。由于1/f噪声渐进的逼近直流，放大器也能校准这一误差。第一代自稳零放大器不表现出1/f噪声，因而适用于低频传感器信号调理。第二代自稳零放大器具有较低的宽带噪声（22nV /dB），通过P

19、Spice宏模型能精确的仿真放大器电压噪声，显示出1/f噪声已被消除13。2轨到轨输入 对于低压设计来说，轨到轨（RR）输出和输入可能是适合的。当共模输入从一条轨转到另一条轨时，一个差分输入对停止工作，另一个差分输入对则接着工作。失调电压和输入偏置电流可能突然变化，引起的失真。对于低噪声设计来说，请检查对轨到轨输入特性的需求。为了解决这个问题，ADI公司的AD8506 等运算放大器使用内部电荷泵来消除输入电压交越失真。如果设计不正确，而使电荷泵产生的噪声落入有用频带时，这些噪声将会出现在输出端，引起问题。3偏置电流消除 最新的双极性运算放大器使用一种技术来消除输入偏置电流造成的部分影响，这个技

20、术会增加不相关或相关的电流噪声。对于一些放大器来说，相关噪声可能大于不相关噪声。例如：ADI公司的OP07增加阻抗平衡电阻，就能改进整体噪声。ADI公司两款广泛应用的运算放大器，一款是用较高电压噪声换取较低电流噪声的OP07，另一款是OP27。从可获得的低噪声器件中选择三到四个器件。考虑工艺技术，寻找自稳零、斩波和偏置电流消除等专业设计技术。从晶圆照片查看输入晶体管区域，大输入晶体管的噪声较低，但具有大的输入电容，而CMOS和JFET放大器的电流噪声远小于双极性器件。低噪声设计要使用小电阻，所以放大器输出驱动必须足够大，以驱动大负载。4无源元件的选择 选择放大器之后，在放大器周围放置合适的电阻

21、和电容，而这些元件也有噪声。输出噪声随着用于设置增益的电阻的增大而增大。在忽略R1和R2的噪声，集中考虑源阻抗R的噪声，当R值较小时，电压噪声占主导地位；当R值为中等大小时，John噪声占主导；当R值较大时，电流噪声的贡献较大。因此，低输出阻抗的传感器应该使用小电阻和具有低电压噪声的运算放大器。除电阻之外，电容也能用于补偿和减小噪声。电抗元件不增加任何噪声，但流经它们的噪声电流将产生噪声电压，影响计算。总之，重要的是在放大器周围使用低阻抗来降低电流噪声、热噪声和EMI杂散干扰拾取的影响。5带宽选择选择好放大器以及相关的电阻和电容之后，下一步是设计最佳带宽（BW）。不要设计过宽的带宽，带宽应该足

22、够通过基频和重要的谐波，但不要过宽。选择具有足够带宽的放大器，在其后放置RC滤波器，放大器本身也是单极点滤波器。放大器和电阻在带宽范围内都有噪声，因此，带宽越大，输出噪声越大，SNR越低。为限制附加的噪声，带宽应该尽可能的窄。为限制带宽，在传感器之后使用 RC 滤波器，产生的负载问题可使用缓冲器来解决。具有适配规格和配置的放大器（放大器带宽为350MHz）和ADC将具有166Vrms的噪声。在运算放大器之后增加RC滤波器后，将产生50MHz的有效带宽，能把噪声降低到56Vrms。使用正确的RC减小带宽能极大的提高SNR，但是电阻本身会增加噪声。降低带宽的另一个更好的办法是设计一个的电路，使其电

23、阻放入运算放大器的反馈环路中，将其影响降低（1+环路增益）倍，不要忘了在电源引脚使用足够的去耦电容来降低信号路径的电源噪声。 图2.3 信号处理电路框图2.2.2信号标定信号处理电路主要由稳压器、脉冲发生器、电桥、信号差分放大器、带通滤波器和相敏解调器等构成，以下是对各个电路的分析说明14。（1）脉冲振荡电路用脉冲方波给电容充电，振荡电路由施密特触发器7Z14和电阻、电容组成、REF195给振荡电路提供稳定的5V基准电压。在接通电源时，电容上的电压从0V开始按RC充放电的指数形式上升变化，当上升电压超过施密特触发器的阀值电压Vp时，就判定输入为高平，于是反相器的输出变为低电平0V，输出为低电平

24、时，电容C中充电电荷又通过电阻R放电，当C上电压降到阀值电压Vn时，判定为低电平，到达阀值时，输出低电平。这样复始周期高压电平的变化，就形成了一定频率 方波信号，决定此电路的振荡频率的是RC的时间常数。振荡周期的倒数是频率，振荡周期等于充放电的时间之和，根据理论计算振荡周期近似等于T=0.6RC。（2）差分放大部分差分放大采用美国ADI公司的仪表集成运算放大器AD620，它运放功耗低，最大电流只有1.3毫安，线性度高，50uV的失调电压，0.6uV/的温度漂移，低噪音，低输入偏置电流。只用一个电阻即可在11000内调节放大倍数，芯片采用正负双电源供电，为防止外界的干扰信号通过电源引入芯片，在芯

25、片的电源引脚边加上滤波电容。电容敏感信号接到AD620的2，3脚，在6脚输出，双端输入，单端输出。图2.4差分放大电路（3）滤波放大电路部分AD620的输出信号经过隔直电容后进行滤波放大。这部分电路兼具信号滤波和放大作用。在运放的3脚接了一个R6，此电阻是直流偏置电阻，为放大器提供直流偏置。输入直流信号时，放大倍数由R8和R7的比值决定，当输入信号的频率逐渐变大时，由于电容的容抗与通过它的频率 ，所以频率变大，C22容抗变小，C22和R8组成的等效阻抗变小，运放输出电压就变小。当频率高于一定值后，就失去了放大作用。因此我们可以粗略的估计一个截至频率，让截止频率的信号顺利通过，高于截至频率的信号

26、衰减。截至工作频率由RC时间常数决定。在这一部分中可以调整R8和R7的大小来确立比例系数的大小。图2.5 放大滤波电路（4）低通滤波低通滤波部分采用有源的二阶低通滤波器。低通滤波器的作用是让截至频率以上的信号。理论上是这样，但实际上幅频特性曲线不可能做到当高于某一频率时直线下降，而是随着频率的增加，缓慢的衰减。设置此部分电路的Q值为1，根据RC时间常数值，算出截至频率为=1/RC。根据不同陀螺使用的不同要求，可以调整R、C的大小来满足测量范围的要求。图2.7 低通滤波3.陀螺信号的测量3.1引言在学习了解硅微机械陀螺的结构原理几信号值后，开始对其信号经行测试。这是初步的测试，硅微机械陀螺的输出

27、信号是由多个姿态信息混合在一起的复合信号。交流电压只是表示测量信号的有效值，不是测量瞬时值，不能反映信号的及时特性，也不便于仿真，建立数字测试系统就成为必须。图3.1 数字测试系统框图陀螺信号是通过采样开关进入测试系统，信号在通过采样开关以及数字电压表的时候，不可避免的会受到干扰，而且会随着元器件的老化而加大干扰，对陀螺的测试造成很大的问题，所测得的数据并不能真实反映陀螺本身的性能，使陀螺达不到技术指标，这就必须在信号进入时测试中心时进行A/D转换。考虑到系统需要A/D转换及能够完成信号处理的要求，在次选用TI公司的MSC1214系列的单片机作为测试系统的数据采集器。它拥有24位的高精度采样器

28、并采用先进的-采样技术，完全可以满足系统的要求。使其跟陀螺仪安装一起，采样程序可烧写到单片机中，配合计算机中的软件组成整个测试系统。具体的实现以后章节详尽介绍，计算机中软件编写采用C语言。3.2 陀螺信号的测试对硅微机械陀螺的几个主要特性的测试：（1）分辨率：0.05（）/s;（2）零 位：DC 1.4mV，AC（仿真器以一定频率）20.2 mV；（3）当仿真器以不同频率旋转时，输出信号与输入角速度的关系。表3.1 输出信号与输入角速度的关系（高速时）/s/Hz 50 100 150CW CCW CW CCW CW CCW6382.5363.6757.6755.81164.51125.2118

29、64.3845.41780.61773.72571.82594.5171284.11275.62582.02592.63861.43791.4251662.01442.43094.23070.44590.64645.0稳定性/%38.940.238.339.739.540.2表3.2输出信号与输入角速度的关系（低速时）/s/Hz 50 100 150CW CCW CW CCW CW CCW67.7667.0517.6857.2907.0896.8651117.25316.06317.10316.76117.21016.3581725.46224.96025.31425.18325.01325.

30、0792531.26030.86130.75830.51330.49030.3604 硅微机械陀螺信号的处理及标定4.1引言从理论及分析和测试结果看，硅微机械陀螺信号的输出信号是一个动态的信号，它不受角速度的影响，从中提取有用的姿态信息，就是我们研究的主要内容15。4.2 信号的特征角振动幅度为：=() sin(t)，其中()=（C+B-A）( C-B-A)2+K2+(D)2；假设整个检测和处理电路的传递函数为I，那么经过电容检测和预处理后，输出的信号电压U可以表示为：U=I()sin(t)； 如果将被测角速度在相对于硅摆，分为偏航角速度。和俯仰角速度。；当只有偏航角速度时，陀螺经过电容 电路

31、输出的理想电压信号简化为:Ux=Ix()。sin(t)；当只有俯仰角速度时：Uy=Iy()0cos(t)；则二者都有时为：U=Ux+Uy= Ux=Ix()。sin(t)+ Uy=Iy()。cos(t)。4.3 信号的解调在分析硅微机械陀螺信号特征之后，处理的方法很多，考虑到便于实现的角度出发，解调信号的数字方法又很少，包括最小误差解调和峰值检测和相位比较解调。我们这里采用较为常用的相位比较解调。4.3.1 算法原理由上所诉得U=Ux+Uy= Ux=Ix()。sin(t)+ Uy=Iy()。cos(t)变形可得U=Mcos(t+),其中M=(A12+B12)1/2；=arctan(-A1/B1)

32、，A10；=arctan(-A1/B1)+ ，A10；由此得到M就是信号的峰值点，可以利用检测峰值点的办法可以得到角速度的大小，却无法得到横向角速度的方向即。为了得到的值，利用重力加速度计的信号。理想情况下重力加速度在载体自转时的输出信号为：U1=C cos(t)，其中C为常量。比较上式可知，U1是U的载波，只要比较它们的相位即可得到，也确定了横向角速度的方向，这就是峰值检测与相位比较的方法。4.3.2 算法的实现从算法原理知，峰值检测和相位比较解调的方法较简单，通过以下步骤即实现：（1）分别记录重力加速度计和陀螺信号的过零点时间和过零点的方向；（2）分别计算重力加速度计和陀螺信号的相邻过零点

33、的时间间隔；（3）补偿由安装角度引起的相位差及重力加速度计和陀螺信号本身的相位差；（4）据陀螺和重力加速度计过零点时间间隔和过零点的方向求其间的相位差；（5）检测出陀螺信号的峰值；通过以上步骤就可完成陀螺信号的解调，便于实现。5 陀螺信号的软硬件实现5.1 引言在解决了算法的问题后，接下来我们要实现硬件电路的设计。目前国内外信号处理现状是模拟多路开光（MUX）、程控放大器（PGA）、采样/保持器、A/D和D/A转换器等功能器件集成到一块PCB板上进行信号的处理。为了能够更科学经济的对陀螺信号的检测与标定，这里采用TI的MSC1210单片机，MSC1210作为一款高性能的内核兼容8051的单片机

34、，其开发的方便、灵活和高精度ADC的使用满足了使用者的要求，其指令执行速度更是实时系统所渴求的，可广泛用于工业过程控制、医疗仪器、智能传感器等各个领域。5.2 MSC1210的结构与性能TI的MSC1210单片机解决了上述问题。它有3个16位的定时器，16位PWM波输出，多达21个中断源，32个数字输入/输出端口，带有看门狗，8路ADC提供24位分辨率可编程的无丢失码解决方案，可编程增益放大（PGA）在1128之间可调，极大提高了ADC精度，供电电源2.75.25 V，在3 V时功耗低于4 mW，停止方式电流小于1A，内核兼容8051，指令与8051完全兼容，可以使用原有8051开发系统，时钟

35、频率可达33 MHz，单周期指令执行速度达8 MIPS，执行速度比标准8051快3倍，高达32 KB的Flash存储器，SRAM达1.2 KB，外部可扩展至64 KB存储器，Flash在电压低达2.7 V时仍可串行或并行编程，可10万次擦除/写操作，具有32位累加器，有电源管理功能，能够进行低电压检测，在片上电复位，带FIFO的SPI端口，双UART，64TQFP封装，MSC1210系列的硬件和引脚完全兼容，必要时可以互换。图5.1 MSC1210单片机的引脚图表5.1 MSC1210的Flash分区HCR0MSC1210Y2MSC1210Y3MSC1210Y4MSC1210Y5DFSELPM

36、/KBDM/KBPM/KBDM/KBPM/KBDM/KBPM/KBDM/KB0000408-0010408-03201004080161616011040888248100044412428410122621423021103171151311111(缺省)4080160320注：当程序空间选择0KB时，程序在片外执行；一表示保留。5.3 接口电路的设计5.3.1 陀螺的接口电路根据MSC121x的电器参数可知，当AVdd=5V时，模拟信号输入的范围0V5V，而陀螺的输出电压大概在-10V+10V左右，为了达到采样的要求陀螺信号在进入单片机之前进行处理，其方法是先将陀螺信号缩放到的1/4，进过

37、放大电路的电压信号是-2.5V+2.5V，再将它抬高到0V5V，这样就达到了单片机模拟电压的采样要求。图5.3陀螺的接口原理图5.3.2 重力加速度计的接口电路重力加速度计信号中的直流分量会在不同转速下有很大的变化。为了解决这个问题，首先对信号进行隔直流的办法把直流分量滤掉，然后再加上2.5V的直流电压上去，这样不但解决了上述的直流不稳定问题，也解决了单片机采样中公共基准零点的电压问题。 图5.4 重力加速度计的接口电路5.3.3 外围电路的设计综合MSC121x芯片等元器件的选择以及振荡器时钟功能可靠性，我们采用33MHz的晶体振荡器。（1）时钟电路：图5.5 晶振时钟电路图（2）复位电路：

38、为确保微机电路系统中稳定可靠工作，复位电路是必不可少的一部分，复位电路的第一功能是上电复位。一般微机电路正常工作需要供电电源为5V5%，即4.75V5.25V。由于微机电路是时序数字电路，它需要稳定的时钟信号，因此在电源上电时，只有当VCC超过4.75V低于5.25V以及晶体振荡器稳定工作时，复位信号才被撤除，微机电路开始正常工作。图5.6 复位电路（3）串口通信电路：该系统实现串口模块主要是与上位机进行通信，单片机单片机 全文系统将采到的数据送到上位机进行处理，从而减轻单片机单片机是单片微型计算机（Single-Chip Microcomputer）的简称，是一种将中央处理器CPU随机存储器

39、RAM、只读存储器ROM、多种I/O口和中断系统、定时器/计时器等功能（可能还包括显示驱动电路、脉宽调制电路、模拟多路转换器、A/D转换器等电路）采用超大规模集成电路技术集成到一块硅片上构成的微型计算机系统。 系统的处理负担。由于单片机与上位机进行通信时接口电平不同，因此需要进行接口转换，这里采用来MAX323完成接口电平的转换。图5.7串口通信电路5.4 软件设计5.4.1 系统框架图图5.8程序流程图5.4.2 主程序：i nclude i nclude i nclude iic.h #define uchar unsigned char #define uint unsigned int

40、 uint Timer_Pro_Flag=0; sbit TEST_CAP_VOL_CRLT=P10; sbit PWM_Pin=P37; sbit IrDA_in_Pin=P10; bit PWMFlag=0; uchar OLD_TH0,OLD_TL0; #define MAXCMD_LENGTH 7 #define AD_VOL_PER 1.04058 #define AD_Loop_PickVol_PER 1.04058sbit WDTRST=0xA6; sbit ADCLK=P20; sbit ADOUT=P21; sbit ADCS=P22; |端口 | INH C B A | |

41、 | |- 7 6 5 4 3 2 1 0 | 正值 | 取反 | | 0 |0 0 0 0 0 0 0 0 | 0x00 | 0xff | | 1 |0 0 0 0 0 0 1 0 | 0x02 | 0xf7 | | 2 |0 0 0 0 0 1 0 0 | 0x04 | 0xfb | | 3 |0 0 0 0 0 1 1 0 | 0x06 | 0xf3 | | 4 |0 0 0 0 1 0 0 0 | 0x08 | 0xfd | | 5 |0 0 0 0 1 0 1 0 | 0x0A | 0xf8 | | 6 |0 0 0 0 1 1 0 0 | 0x0C | 0xf9 | | 7 |0

42、0 0 0 1 1 1 0 | 0x0e | 0xf1 | uchar CD4051_NUM=0x00,0x02,0x04,0x06,0x08,0x0A,0x0C,0x0e; sbit CD4051_A=P11; sbit CD4051_B=P12; sbit CD4051_C=P13; sbit CD4051_INH=P14; bit CD4051_Vol_Conver_Flag=0; uchar LedCount=0; uchar LED_BIT5; uchar LED_NUM=0x00,0x10,0x20,0x40,0x80;void SendByte(unsigned char wor

43、d) TI=0; SBUF=word; while(TI=0); TI=0; uchar ComBufMAXCMD_LENGTH; void delay(uint t) uint i=0; for(;i=t;i+); void Pluckdelay(uint t) uint i=0,j; for(;i=t;i+) for(j=1;j=MAXCMD_LENGTH) n=0; else n+; void SendByteArray() unsigned i; SetCheckSUM();ComBuf4=P0; ComBuf6=0x7e; for(i=0;i=MAXCMD_LENGTH-1;i+)

44、SendByte(ComBufi); WritePortData() ;void SetEA() if (ComBuf1=0x00) EA=ComBuf3; else ComBuf3=EA; SendByteArray(); void Befor_Once_AD() uchar i; ADCLK=ADOUT=0; ADCS=0; for(i=1;i=10;i+) ADCLK=1; ADCLK=0; ADCS=1; delay(25); GetAD()sbit ADCLK=P20; bit ADOUT=P21; sbit ADCS=P22; void GetAD() uchar i=1,w,PickCount; uint vol; Befor_Once_AD();if (ComBuf1=0)ComBuf1=0x01; PickCount=ComBuf1; for(w=