基于振动陀螺的动态零位校准及其误差补偿

合集下载

陀螺罗经误差及消除

2.外补偿法
转动罗经基线或刻度盘
3.内补偿法
施加垂直轴补偿力矩，产生V1`以抵消V3
冲击误差
一．定义
船舶作机动航行时由于作机动航行的加速度引起的惯性力作用于陀螺罗经上而使主轴偏离其稳定位置所产生的误差B。二．冲击误差的分类第一类冲击误差：惯性力作用于控制设备上（BI ）
第二类冲击误差：惯性力作用于阻尼设备上（ BII）
三、摇摆误差的消除：
➢下重式（安许茨）罗经：采用双转子。
➢液体连通器（斯伯利）罗经：采用高粘性的硅油。
➢电控式罗经：采用在强阻尼电磁摆内设置高粘性硅油。
➢总的消除原则:增长陀螺球的摇摆周期
一.定义：
基线误差
ห้องสมุดไป่ตู้
罗经的基线与船舶首尾线不平行引起的读数误差。包括主罗经基线误差、分罗经基线误差和传向误差。
五.速度误差消除
1.速度误差校正表
把αrv按不同的航速V航向C和地纬度φ计算后绘成表格或图表
的形式,以便使用罗经时查用。使用时注意: （1）据航速、航向和纬度来查速度误差值。
（2）在书中的表上，按航海习惯规定：正号为东差；负号为西差。
（3）真航向＝罗经航向＋速度误差（4）若表中无对应的V、C和纬度时，可用内插法或选取与其接近的数值。
第一类冲击误差设船舶在北纬某处，航向为C作加速机动航行。
机动前的航速为V1，则主轴的稳定位置为 r1 机动后的航速为V2，则主轴的稳定位置为 r2
船舶机动末了时刻主轴的位置为A点
速度误差之差：
冲击位移：
主轴冲击进动的三种情况
r 1.当船舶机动终了时,主轴正好进动到新的稳定位置 2,
图2－6
2.当船舶机动终了时,尚未由r1转向r2,落后于r2位于1的位置

微型垂直基准仪的陀螺动态误差补偿

（ｏｅｅｏＡｔｍｔｎＨｒｉｎｉｅｒｇＵｉｒｔ，Ｈｒｉ１００，ｅｏｇｉｇＣｉ）Ｃｌｇｆｕｏａｉ，ａｂｎＥｇｅｎｎｖｓｙａｂ５０１Ｈｉｎｊｎ，ｈｎｌｏｎｉｅｉｎｌａａ
ＲｅｅｒｈｏｙｏＳＤｙｍｉｒｒｏｉｉｔｅｓａｃｎＧｒ ’ ｎａｃＥｒｏｆＭｎａｕｒＡｔｉｕｄｅＲｅｅｅｃｙｔｍｔｔｆｒｎｅＳｓｅ
ＨＥＫｕｎｐｎ－ｅｇ，ＷＵｕ — ｉＩＪｎｗｅ，ＬＡＮＧｉｂＨａ — ｏ
ｉｒｏｆＭＥＭＳｇｒｓｈａｏｂｏｃｅｒｒｏｙｏｓｔｅｃｍｐｅａｅｎｓｔｄ．Ｂａｅｎａｌｚｎｈｙａｃｅｒｒｓｕｃｓｏｅｅｒｒｓｄｏｎａｙｉｇｔｅｄｎｍｉｒｏｏｒｅ，ｓｍｒｏ
摘要：为了提高舰载微型垂直基准仪的姿态测量精度，必要补偿系统中陀螺的动态误差。有在分析系统动态误差原因的基础上，立了ＭＥ建ＭＳ陀螺的非线性误差、对称性误差和角加速度不
项误差模型；别采用自适应分段的方法补偿非线性误差，型中增加角速度绝对值项补偿不对称分模
性误差，并用Ｄ一最优试验设计准则和最小二乘法辨识出角加速度误差模型参数。试验结果表明，该误差补偿方案能将系统的姿态测量精度提高约５倍，明了误差补偿模型和方法的有效性。证关键词：器仪表技术；惯性导航；垂直基准仪；微机械陀螺；动态误差仪中图分类号：６６１Ｕ６．文献标志码：Ａ文章编号：１０ —０３２１）８１９－７００１９（０００ —ｌｎａｒｏｄｌ，ｕｃｓｎｎｉｅｒｅｒｒ，ａｙｍｅｒｒｏｓｍｔｙｅｒｒ，ａｎｕａｃｅｅａｉｎｅｒｒ，ｗｅｅｓｔｕｅｐｃｉｅｎｄａｇｌｒａｃｌｒｔｏｒｏｒｅｐｒｓｅｔ－ｖ

陀螺罗经误差及其消除3

陀螺罗经误差及其消除3陀螺罗经的主轴在方位上偏离地理真北方向的角度称为陀螺罗经误差。

陀螺罗经误差也是船舶真航向与陀螺罗经航向之间的差值或真北与陀螺罗经北之间的差角。

陀螺罗经误差有纬度误差、速度误差、冲击误差、摇摆误差和基线误差。

纬度误差 (latitude error)纬度误差产生的原因位于北纬φ处的具有阻尼重物的水银器式罗经,稳定后罗经主轴并不恰好位于子午面内,而是偏离子午面一个角度αr,当罗经的结构参数M、M D确定后,αr角仅与地理纬度φ有关,故称为纬度误差。

产生纬度误差的原因是由于了采用垂直轴阻尼法。

因此,纬度误差是采用垂直轴阻尼法罗经特有的误差;它属于垂直轴阻尼法陀螺罗经固有的特性。

纬度误差的消除方法为了提高陀螺罗经的使用精度,应想方设法对纬度误差进行补偿,最好完全予以消除。

实践中,对纬度误差的补偿方法有两种——外补偿法和内补偿法。

(1)外补偿法,是利用一套解算装置,根据误差公式计算出误差的大小和符号,从罗经的航向读数中扣除误差的方法。

可通过转动基线或罗经刻度盘,使基线与转动的角度等于误差值,或罗经刻度盘使其转动的角度与纬度误差αrφ等值反向,从罗经刻度盘上读取的航向即为不包含误差的真航向。

需强调指出,外补偿法仅从罗经刻度盘中扣除误差值,并未改变罗经主轴的稳定位置。

(2)内补偿法或称力矩式补偿法,是利用一套解算装置,计算并输出与误差相关的补偿力矩,抵消引起误差的力矩，使主轴可稳定在子午面内,从根本上消除了误差的方法。

在实践中纬度误差内补偿方案有两种:对陀螺罗经的水平轴OY施加纬度误差补偿力矩,即M Yφ＝Hω2；或对罗经的垂直轴OZ施加纬度误补偿力矩,即M Zφ＝εHω2。

在Sperry MK37型罗经中采用垂直轴内补偿方案（ε＝（M D/M））。

在阿玛—勃朗10型罗经中采用水平轴内补偿方案。

需要说明的是，补偿力矩的符号是与罗经所在纬度极性有关的，如将符号取反，不仅不能消除误差，反而使误差增大一倍。

动态环境下光纤陀螺误差辨识与补偿技术

动态环境下光纤陀螺误差辨识与补偿技术张峰;黄继勋;王颂邦【摘要】为了提高光纤陀螺在高动态环境下的测量精度,需要精确地辨识角加速度信息以便有效地补偿.针对直接对陀螺的角速度信息微分处理后得到角加速度的方法误差较大的问题,提出了将微分后的角加速度信息分为线性和非线性两个部分,其中线性部分采用Savitzky-golay最小二乘拟合,而非线性部分则采用RBF神经网络技术进行拟合.上述处理方法能更真实地反映实际物理过程,具有较强的自适应性和较好的拟合效果.通过试验验证,证明了该方法的有效性和准确性,提高了角加速度辨识精度,比直接微分的方法测量精度提高二个数量级,有效地补偿了陀螺仪在高动态环境下的测量精度.%To improve the precision of fiber optic gyroscope (FOG) in high dynamic environment,the angular acceleration must be accurately identified to make effective compensation.In view that the FOG angular acceleration obtained by direct differentially processing the FOG angle velocity information has relatively large errors,the angular acceleration information is divided into the linear part and the nonlinear part.The linear part uses savitzky-golay algorithm to carry out least square fitting,while the nonlinear part uses RBF neural network (RBF NN) method to carry out fitting.This method has more strong adaptability and has better fitting effect because it can more truly reflect the real physicalprocess.Finally,simulations are made to test and compensate the measurement errors of FOG angular velocity under high dynamic environment,which verifies that the algorithm is correct and effective,and the identification accuracy of the angular acceleration is improved by twoorders of magnitude than that of the direct differential method,showing that the proposed method can effectively compensate the FOG measurement errors under high dynamic environment.【期刊名称】《中国惯性技术学报》【年(卷),期】2016(024)006【总页数】5页(P775-779)【关键词】光纤陀螺;动态环境;角加速度;Savitzky-golay拟合;RBF神经网络【作者】张峰;黄继勋;王颂邦【作者单位】北京航天时代光电科技有限公司,北京100094;北京航天时代光电科技有限公司,北京100094;北京航天时代光电科技有限公司,北京100094【正文语种】中文【中图分类】U666.1光纤陀螺是一种基于Sagnac效应的角速度敏感器[1]，具有体积小、重量轻，精度高，动态响应带宽高等优点，非常适合飞行器上应用。

动力调谐陀螺仪误差分析及补偿技术——陈智民共21页文档

31、只有永远躺在泥坑里的人，才不会再掉进坑里。——黑格尔 32、希望的灯一旦熄灭，生活刹那间变成了一片黑暗。——普列姆昌德 33、希望是人生的乳母。——科策布 34、形成天才的决定因素应该是勤奋。——郭沫若 35、学到很多东西的诀窍，就是一下子不要学很多。——洛克
动力调谐陀螺仪误差分析及补偿技术——陈智民
6、法律的基础有两个，而且只有两个……公平和实用。——伯克 7、有两种和平的暴力，那就是法律和礼节。——歌德
8、法律就是秩序，有好的法律才有好的秩序。——亚里士多德 9、上帝把法律和公平凑合在一起，可是人类却把它拆开。——查科尔顿 10、一切法律都是无用的，因为好人用不着它们，而坏人又不会因为它们而变得规矩起来。——德谟耶克斯

激光陀螺仪误差分析与补偿技术课件

法称为动态自动补偿。
激光陀螺仪误差分析与补偿技术
16
《激光陀螺随机漂移的数字滤波方法研究》激光陀螺的随机漂移噪声类似于白噪声，它是影响激光陀螺精度的重要因素，采用数字滤波的方法可以减小随机漂移对激光陀螺精度的影响。常见‘AR（2）模型’、‘卡尔曼滤波’、‘小波分析’和‘小波包分析’这四种数字滤波方法，可以利用功率谱和Allan方差的分析方法对这几种滤波效果进行比较。结果表明，对于激光陀螺的随机漂移的滤除，基于AR模型的卡尔曼滤波法的效果最好，基本上消除了陀螺的随机误差，而小波分析法和小波包分析法只能在
激光陀螺的主要误差一些论文中激光陀螺的补偿方法
激光陀螺仪误差分析与补偿技术
1
激光陀螺仪的工作机理与刚体转子陀螺仪有着根本区别，因此二者的误差源亦完全不同。激光陀螺仪不存在与线运动及角运动有关的误差，
这是一个突出的优点。
激光陀螺仪误差分析与补偿技术
2
激光陀螺的主要误差源
闭锁效应：原因：
由于激光介质的色散、模式牵引和反射镜等光学元件对光束的后向散射等原因，有源环形腔内正、反向行波的频率接近到一定程度时，将突然变成完全一样，即存在一个可能达到的最小频差X，一旦频差小于X，就将变为0.因此当输入转速小到一定程度时，有源环形腔内正、反向行波模对的频率将趋于完全相同。上述现象即为激光陀螺进入锁区，此区域内输入转速不被敏感。缩小锁区、消除
航系中有规律的变化。
激光陀螺仪误差分析与补偿技术
10
激光陀螺仪误差分析与补偿技术
11
激光陀螺仪误差分析与补偿技术
12
激光陀螺仪误差分析与补偿技术
13
3.神经网络拟合方法
多项式拟合和多元逐步线性回归的补偿方法都必须建立在某个准确的数学模型之上，但实际上，这种准确的数学模型是很难建立的，上面所用到的简化模型仅仅是实际问题的一个最优近似。神经网络不依赖任何确定的数学模型，且理论上已证明，至少含有一个S型隐层再加上一个线性输出层的BP神经网络，能够通过自学习逐步逼近任意有理函数，所以，建立温度零偏误差的BP神经网络模型是进一步提高补偿精度的重要手段。

光纤陀螺仪误差分析与补偿

美国的AIM一120B／C型中距空空导弹，AGM一142空地导弹都采用LN200光纤陀螺惯性测量组件。LN一200采用的光纤陀螺，它与微硅加速度计一起构成的整个惯性测量组合。
2004 年1月26日，美国的“勇气”号和“机遇”号探测车经过7个月飞行后成功登陆火星，所用的导航系统为诺斯罗普·格鲁门公司生产的光纤陀螺导航系统。该系统提供了飞船飞行中姿态测量所需的线加速度和角加速度信息；确定了飞船进入火星大气层缓慢降落和着陆伞最佳打开时机；提供了火星探测车在火星陆地表面运动过程中姿态、速度信息和探测车上高增益天线的定位。
光纤捷联惯性导航系统
参考文献
[1]邓志红，付梦印，张继伟，肖烜. 2012. 惯性器件与惯性导航系统[M]. 北京：科学出版社. [2]Herve C．Lefevre．光纤陀螺仪[M]．张桂才，王巍，译．北京：国防工业出版社，2002 [3]吉云飞，黄继勋. 光纤陀螺仪预滤波技术研究及应用[J]. 导航与控制. 2011.10(2):34-38. [4]董庆亮，杨建宇. 光纤陀螺仪及其在海洋重力仪中的应用[J].测绘时空. 2011.2 . [5]王巍，杨清生，王学锋. 光纤陀螺的空间应用及其关键技术[J]. 红外与激光工程. 2006. Vol.35. No.5: 510-512. [6]杨亭鹏，刘星桥，陈家斌. 光纤陀螺仪(FOG)技术及发展应用[J]. 火力与指挥控制. 2004 .29(2):76-79. [7]顾宏. 高精度光纤陀螺仪及其关键技术研究. 南开大学博士学位论文. 2008. [8]毛奔，林玉荣. 惯性器件测试与建模[M]. 哈尔滨工程大学出版社. 2009.
5）抑制光电检测器及电路的噪声；
6）提高FOG的环境适应性；

mems陀螺随机误差建模与补偿

mems陀螺随机误差建模与补偿最近，Mems陀螺（Micro Electro-Mechanical System Gyroscopes）已经广泛应用于航迹控制、汽车安全驾驶、水下航行、航空运动等多个领域。

Mems陀螺在操作和维护方面的优势已经受到越来越多的关注，但是由于Mems陀螺的体积小，它的输出电平也相对较低，这就导致了它受到很多不同的随机误差的影响，这令其在实际应用中受到了很大的限制。

为了解决这一问题，研究人员研发了基于Mems陀螺的随机误差建模与补偿技术，以提高它们在实际应用中的精度和可靠性。

Mems陀螺受到的随机误差往往来自于传感器本身的结构参数以及外界环境的影响。

例如，由于传感器的结构参数的不稳定性，可能会导致传感器的输出电平有所变化，从而影响传感器的输出结果。

除此之外，外界环境的影响也会对误差的大小产生一定的影响。

例如，外界的温度和湿度的变化可能会对陀螺的误差产生不同的影响，这就需要对这些误差进行建模和补偿。

为了建模和补偿Mems陀螺的随机误差，首先需要针对传感器本身的结构参数进行深入的研究和分析，以建立传感器在结构参数变化时误差变化的模型。

其次，需要研究外界环境对Mems陀螺结构参数的影响，并建立数学模型来描述该影响，以及建立外界环境的误差补偿模型。

最后，要将结构参数误差模型和外界环境误差补偿模型集成到一起，以形成最终的Mems陀螺随机误差建模与补偿模型。

基于Mems陀螺随机误差建模与补偿技术，可以有效抑制Mems陀螺的误差，提高其在实际应用中的精度。

因此，这一技术已经在航迹控制、汽车安全驾驶、水下航行、航空运动等多个领域得到了广泛的应用，取得了很好的效果。

然而，建立一个准确的Mems陀螺随机误差建模与补偿模型需要极大的计算量，传感器参数和外界环境的变化也会对模型的准确性造成一定影响。

另外，传感器本身的细微误差也会改变传感器的输出，从而引起误差模型的变化，这也是模型准确性的重要影响因素。

1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。

收稿日期:2007211206

基金项目:重庆市科委自然科学基金资助项目(CSTG2007BB2448,CSTG2007BB4385);重庆邮电大学博士启动基金资助项目(A2007245

)

作者简介:刘宇(19722),男,重庆人,博士,主要研究方向为惯性导航及信号处理。

文章编号:100422474(2008)0620671203

基于振动陀螺的动态零位校准及其误差补偿刘　宇1,2,刘　俊1,黎蕾蕾2,孙燕彬1,李秋俊1(1.重庆邮电大学光电工程学院,重庆400065;2.重庆大学光电技术及系统教育部重点实验室,重庆400044) 摘　要:根据固态振动陀螺输出信号和噪声特点对其构成的低成本惯性测量单元(IMU)的原始传感信号进行了快速小波滤波和灰色理论建模处理。运用累加生成操作(AGO)方法得到有规则的单值对应非线性函数,并获得陀螺零位输出在三维空间中的单值映射模型。以时间和温度为输入,根据灰色神经网络建立陀螺的漂移模型,对累加生成方法生成的单值对应非线性函数进行逼近,从而提高了动态测量精度。同时采用活动阈值融合算法,优化陀螺和加速度计动态测量数据。实验证明,上述方法和算法有效提高了系统测量精度。关键词:陀螺;惯性测量单元(IMU);滤波;数据融合中图分类号:V241 文献标识码:A

DynamicZeroOutputAdjustmentandSystemErrorCompensationBasedonLowCostVibrationGyro

LIUYu1,2,LIUJun1,LILei2lei2,SUNYan2bin1,LIQiu2jun1(1.CollegeofOptoelectronicsEngineering,ChongqingUniversityofPostsandTelecommunications,Chongqing400065,China;

2.CollegeofOptoelectronicsEngineering,ChongqingUniversity,Chongqing400044,China) Abstract:ThesensorsignalfilteredthroughfastwaveletandcompensatedbyGreymodelwasproposedaccord2ingtothecharacteristicsofsignalandnoiseoutput.Greyaccumulateoperation(AGO)wasadoptedtoachievetheregularlysingle2mappingfunctionandthemodelofsingle2mappingofgyro’szerooutputinthreedimensioncoordi2nates.ThemodelbasedontheGreyneuralnetworkapproximatedthefunctionofcreatedbytheAGOalgorithmandimprovedthemeasurementaccuracyofIMU.Atthesametime,theactivethresholdbasedonthefusionalgorithmwasusedtooptimizethemeasurementdatumofgyroandaccelerometer.Experimentsprovedthesemethodandalgo2rithmincreasedthesystem’saccuracysuccessfully.Keywords:gyro;inertialmeasurementunit(IMU);filter;datafusion

在飞行器低速运动或俯仰和横滚方向改变时,陀螺的模拟输出实际是围绕静态零位点的正负变化曲线。捕捉这种运动状态下的零位一直是姿态测量领域的难点,文献[122]采用硬件实现的动态零位补偿,但效果不好。惯性测量单元(IMU)要实现动态测量,陀螺必须在整个测量时间和工作温度范围内有效补偿零位漂移。零位漂移是一个非线性、非平稳的随机过程,传统的补偿和修正方法很多,常用的方法有回归分析法和曲线拟合法。这些方法的共同处是为消除某种非目标参量对传感器输出特性的影响,系统中必须有相应的设置来测量该目标参量的敏感元件,以测量当前非目标参量的实际值,然后按照传感器事先已有的标定曲线加以修正。但这会增加系统的复杂度和硬件成本,且也只能针对其中的主要因素。目前采用的自回归(AMAR)建模对传感器零位输出进行模拟的方法很难建立准确稳定的AR模型。基于小波分析的趋势项提取方法[3]过程繁杂,且本身存在一定的限制,这种限制在通常情况下会造成虚假的谐波,而依此进行的一系列分析也将失去原有的物理意义。将小波分析理论引入建模数据的预处理,可抑制冲击干扰噪声,提高神经网络的建模精度,但对逐次启动参数的不一致和多值对应的性能参数并不能很好地模拟[4]。神经网络得到的近似补偿模型包含了所有的非线性影响因素,但建模精度将受数据随机性的影响,随机性越大,建模精度越低,反之亦然。因此,如果在不充分考虑影响陀螺漂移的温度因子和时间因子等多种因素,对数据进行有效的预处理以降低其随机性,则会降低神经网络的建模精度。本文首先对传感器输出信号进行预处理。根据陀螺输出信号特点对原始信号进行快速小波滤波预处理,实现对数据奇异点的检测和去除[5];加速度传

感器、角速度传感器、温度传感器采集经过快速小波滤波预处理后的相应信号,送入DSP完成数据融合计算,应用灰色理论建模,运用累加生成AGO操作,对数据融合计算后给定的陀螺零位漂移数据进行预处理[6]。然后再以时间和温度为输入根据灰色

第30卷第6期压　电　与　声　光Vol.30No.6

2008年12月PIEZOELECTECTRICS&ACOUSTOOPTICSDec.2008神经网络建立陀螺的漂移模型,对累加生成方法生成的单值对应的非线性函数进行逼近,获得均方误差更小和更加接近传感器真实输出的零位电压,从而抑制陀螺角度累积计算误差的主要误差源所造成的系统测量误差。最后,针对陀螺的输出信号特点和在动态测量中的测量方案,采用动态误差补偿算法实现系统测量精度的提高。动态误差补偿主要采用活动阈值和灰色RBF神经网络建模补偿运动中零位输出变化的方法。活动阈值的选取将根据陀螺运行的速度和测量方位的工作状态进行选取,而建模补偿零位输出将在运动中最大程度上跟踪和反映传感器的实际零位输出,从而减小累积计算误差,提高系统精度。1　硬件设计1.1　系统组成图1为IMU系统的实物装配图。该系统主要包括陀螺、加速度计和基于数字微处理器的采集计算专用嵌入式系统。系统通过采集各种传感器信号,经过数字信号转换和处理,实时输出高精度的姿态数据,提供给监控计算机做进一步的处理。

图1　系统装配图IMU系统主要结构由惯性敏感单元和数据处理电路两部分组成。惯性敏感单元由3个正交放置的单轴压电陀螺和3个正交放置的单轴MEMS加速度计组成,数据处理电路完成惯性敏感器件输出模拟量的采集、滤波、计算处理和对外通信等功能。1.2　电路结构嵌入式采集计算系统实质上是多传感器信息采集和数据融合计算的硬件平台。由于本文设计涉及复杂的小波处理和卡尔曼滤波,既要保证计算的精度,又要保证计算的实时性,因此,采用了DSP+

MCU的双CPU结构。图2为系统硬件结构[3]。

图2　硬件结构示意图

DSP选用TMS320F206,该DSP的时钟频率为160MHz,内部RAM为128kbit,6通道的DMA,1路定时器。作为数据计算平台的主处理器,该芯片的计算能力能达到系统要求。同时,由于该芯片还含有3路McBSP(多路缓冲串口),在一定程度上减轻了MCU接口扩展的负担。2　数据处理图3为系统误差动态补偿工作流程图。其处理过程主要包括传感器数据的采集处理和动态测量精度补偿,该动态补偿主要包括初始零位校准、动态零位的捕捉及数据融合计算等。在进行动态补偿处理前,传感器采集的陀螺数据已完成了快速小波滤波去噪。在机械安装结构上,加速度计水平安装,且和陀螺测量同一个角度。多传感器数据处理模块实时判断系统的运动状态,对不同运动状态采用不同的传感器数据或二者的融合,当系统处于超低速或静止状态时,直接采用加速度计输出数据,当系统处于较高度或速度变化较快时,如系统开始转动或突然停止时,则采用陀螺输出数据。将运动状态分为高速运动状态、低速运动状态和静止状态等多个等级,

用活动阈值的方法实时调整,以达到系统的最高测量精度和最佳运行稳定度。

图3　系统误差动态补偿工作流程图初始零位的校准采用启动数据的零位补偿计算与历史存储零位综合判断校准的方法确定零位数据。运用灰色神经网络建模补偿算法计算陀螺的优化零位输出,同时调出最后一次关闭系统时的校准零位作为参考,采用权重评判条件,综合判断校准陀螺的初始零位。其余传感器因启动零位重复性较好,故采用平均值滤波校准可得到理想的效果。陀螺要不静态启动,对模块直接进行零位数据采集,否则调入最后掉电时的历史零位数据,根据上

　672压　电　与　声　光2008年　述数据更新陀螺零位,执行动态零位捕获,根据捕获的动态零位进行角度计算。角度计算采用陀螺和加速度计同时测量,并进行数据融合算法处理。陀螺的输出是一个随旋转速度大小正比变化的电压信号,系统以当时获取的零位输出电压为基准进行时间累积积分,即可获得角度信息;加速度计通过感知地球重力加速度获取角度信息,其模拟电压输出大小直接反映角度大小。两种测量方式对角度测量有各自的适用范围和优缺点,因此必须采用传感器数据融合算法加以优化。在此基础上,结合陀螺和加速度传感器采集的动态数据的实时判断,实现动态自校准和动态测量。实时判断采用多传感器输入数据的融合,判断依据包括当前陀螺输出数据绝对量及当前加速度计输出数据绝对量、陀螺输出数据变化量(与间隔时间为Δt的历史数据比较,Δt根据具体应用环境取值在1～15ms间动态调整)、加速度计输出数据变化量(Δt取值方法与陀螺一样)。通过陀螺输出噪声特点和加速度传感器噪声,结合测量的系统运行特点确定活动阈值A、B、C。活动阈值A即为处于噪声门限处的陀螺电压输出值,将该电压值换算为角度值,并经反复测试优化后确定为阈值A;活动阈值B为当前最新的陀螺输出电压与预定时间Δt前的输出电压差值,它反映速率变化的门限大小,活动阈值C为当前加速度计输出电压与历史数据(前Δt)的输出电压差值,它的选取将根据实测数据分析计算后获得。阈值C综合阈值A、B的当前值所反映的运动状态,判断出加速度计是否敏感了重力加速度或线性加速度,再调用动态零位算法模块,将最后掉电时的历史零位及零位修正数据偏差与活动阈值A进行比较,动态陀螺数据变化量与阈值B进行比较,动态加速度计数据变化量与阈值C进行比较,如果均小于比较值,更新历史的角速度传感器零位输出数据。3　实验结果基于上述原理的姿态角测量,用软件在很大程度上屏蔽了陀螺零位随机漂移引起的测量误差,避免了硬件上的补偿处理,实现了低成本,干扰降低的设计特点。同时,根据需要可灵活调整数据处理算法,以实现不同的测量需求,达到快速、准确、易于实现的设计目标。系统样机组装完成后,进行了反复多次试验测试,试验证明,该样机能完成传感器数据的采集和滤波处理。通过软件建模,对陀螺零位漂移可进行很好的补偿,并对温度引起的传感器性能参数变化有较好的抑制作用。图4为横滚方向进行试验的一组实际测试值,更新频率为50Hz。由图可看出,该系统的软硬件设计达到了数据优化和提高测量精度的目的,能更真实地反映物体的运动状态。