CN106092138A - 一种基于微处理器的硅微陀螺仪温度补偿方法 - Google Patents

一种基于微处理器的硅微陀螺仪温度补偿方法 Download PDF

Info

Publication number
CN106092138A
CN106092138A CN201610395990.2A CN201610395990A CN106092138A CN 106092138 A CN106092138 A CN 106092138A CN 201610395990 A CN201610395990 A CN 201610395990A CN 106092138 A CN106092138 A CN 106092138A
Authority
CN
China
Prior art keywords
wolf
compensation
gyroscope
circuit
silicon micro
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201610395990.2A
Other languages
English (en)
Inventor
李宏生
王凯
黄丽斌
赵立业
朱昆鹏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN201610395990.2A priority Critical patent/CN106092138A/zh
Publication of CN106092138A publication Critical patent/CN106092138A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass

Abstract

本发明公开了一种基于微处理器的硅微陀螺仪温度补偿方法,其主要方法为:(1)先研究硅微陀螺仪测控电路各个环节,再从中选取最合理的接入点,加入数字电路补偿环节;(2)将狼群算法和ARMA模型参数初始化,根据硅微陀螺仪输出数据确定模型训练和测试的样本数据,并对模型输入数据进行去噪和去除趋势项预处理;(3)利用步骤(2)所得的训练数据训练式ARMA模型,通过最小二乘法来确定模型参数,并用狼群算法来优化参数;(4)根据训练好的模型预测硅微陀螺的输出并进行温度漂移误差的补偿;(5)将补偿模型存入单片机中,并将补偿电路设计入整个硅微陀螺仪测控电路中。

Description

一种基于微处理器的硅微陀螺仪温度补偿方法
技术领域
本发明设计微惯性技术与微系统领域,具体涉及一种基于微处理器的硅微陀螺仪温度补偿方法。
背景技术
由硅微加速度计和硅微陀螺仪构成的捷联惯性导航系统具有体积小、重量轻、寿命长、可靠性高、成本低等优点,在姿态测控、武器制导和其它军事领域具有广阔的应用前景。陀螺仪是系统的核心部件,其性能主要由陀螺特性决定,因此陀螺的稳定与否很大程度上影响系统的性能指标。微机械陀螺仪以薄硅片为材料,利用半导体技术制作而成。由于硅材料是一种热敏材料,它的机械、物理特性受温度影响较大。硅材料的硅微陀螺在温度变化时,会出现机械结构变形、硅材料的弹性模量和残余应力变化等现象,同时外围电路元器件的干扰热噪声随温度的改变也会导致硅微陀螺的输出误差。这些都会影响到陀螺仪的输出稳定性及输出精度,从而影响到陀螺仪在各领域的使用。
硅微陀螺仪温度误差补偿方法较多,目前常用的有三种:第一是从陀螺自身的结构出发,改进陀螺自身的结构﹑材料﹑工艺等,从而减小温度变化对陀螺产生的影响。德国HSG-IMIT通过大量研究,研制了带有解耦结构的微机电陀螺,通过支撑梁和框架的特性对陀螺两个模态进行解耦设计,减小了正交耦合误差,很大程度上改善了陀螺仪的温度特性。实验表明全温区的零偏稳定性为±0.3°/s,但这种结构比较复杂,且支撑梁较多,加工相对困难。
第二从外界环境温度出发,采用温度控制的方法,使陀螺工作在恒定的环境温度下东南大学盛霞采用PID控制算法来控制温度,将传感器所得到温度值与设定的温度值比较得到偏差值,偏差值通过控制器和驱动电路得到控制电压,将这个电压施加到半导体制冷器上从而达到控制温度的目的。但加入了温度控制环节,从而增加了电路的复杂度,并且实现高精度控制需要的成本较高。
第三是从温度补偿环节出发,设计温度补偿环节,从而改善陀螺的温度特性。主要的温度补偿方法为以下两种:第一种方法是硬件补偿,例如热敏电阻补偿的方法,热敏电阻是一种对温度非常敏感的电阻器,热敏电阻的阻值会随着温度的变化而改变。其补偿方法主要为:分析整个测控电路并找出影响工作状态的关键点,然后依据热敏电阻的温度系数进行补偿,以减小零偏的变化趋势,该方法技术操作简单,所带来的电路功耗与热噪声较小,但增加了电路硬件复杂度,精度比较低,灵活性也比较差。第二是基于微处理器的软件算法补偿,相比较与硬件电路补偿,该方法灵活性好,并且通过软件可以实现较为复杂的算法。因此,本文提出了一种基于狼群算法的硅微陀螺仪温度补偿方法。
发明内容
发明目的:本发明的目的是提供一种功耗低,响应快,补偿效果好的硅微陀螺仪温度补偿方法,能有效的解决硅微陀螺温度敏感的问题,提高硅微陀螺仪诸多与温度有关的性能指标,从而提高陀螺精度,满足实际迫切需求。
本发明包括如下步骤:
步骤1,在硅微陀螺仪测控电路中选取接入点,加入数字电路补偿环节,即设置硅微陀螺仪零偏补偿点;
步骤2,将狼群算法和自回归移动平均ARMA模型参数初始化,对测试所得数据进行去噪和去除趋势项预处理,并根据所得输出数据确定自回归移动平均ARMA模型;
步骤3,利用步骤2所得的样本数据训练自回归移动平均ARMA模型,通过最小二乘法来确定自回归移动平均ARMA模型中的参数,并用狼群算法优化自回归移动平均ARMA模型中的参数;
步骤4,根据训练好的自回归移动平均ARMA模型预测硅微陀螺的输出并进行温度漂移误差的补偿,得到补偿模型;
步骤5,将补偿模型存入单片机中,将补偿电路设计入整个硅微陀螺仪测控电路中。
其特征在于,步骤1中,将硅微陀螺仪零偏补偿点设置在硅微陀螺仪的最后一级输出上。
步骤3中,自回归移动平均ARMA模型表达式为:
x r + Σ s = 1 n a s x r - s = e r + Σ t = 1 m b t e r - t , e r - t ~ N ( 0 , σ 2 ) ,
上述表达式反映了输出数据序列xr与输入数据序列xr-s的对应关系,等式的左边是自回归差分多项式模型,其阶次为n;右边是滑动平均差分多项式模型,其阶次为m;n、m范围上线是输入数据个数u较小时取u的比例,u较大时取logu的倍数;as、bt分别表示第s个待识别的自回归系数与第t个滑动均值系数;er表示第r个残差;{er-t}序列为白噪声激励;N表示正态分布;σ2为随机变量的方差;er-t~N(0,σ2)表示er-t服从均数为0、标准差为σ的正态分布。
步骤3中,待识别的自回归系数as的最小二乘估计如下:
a ^ s = ( x T x ) - 1 x T y ,
其中,是待识别的自回归系数as的无偏估计,y=[xn+1 xn+2…xN],xN表示响应输出数据序列,其中as=[a1 a2…an],an表示第n个待识别的自回归系数,
x = x n x n - 1 ... x 1 x n + 1 x n ... x 2 . . . . . . . . . x N - 1 x N - 2 ... x N - n .
步骤3中,使用长自回归模型法,待识别的自回归系数as的最小二乘估计如下式所示:
as=-bnIn-m-…-b2In-2-b1In-1+In
其中In表示n阶单位矩阵,bn表示第n个滑动均值系数,
通过下式计算关于的bt线性方程组,得到待识别的自回归系数as的无偏估计
I n + 1 I n + 2 . . . I n + m = I n I n - 1 I n - 2 ... I n + 1 - m I n + 1 I n I n - 1 ... I n + 2 - m . . . . . . . . . . . . . . . I n + m - 1 I n = m - 2 I n + m - 3 ... I n b 1 b 2 . . . b m ,
再通过如下公式计算关于ak的线性方程组,求出滑动均值系数
a 1 a 2 a 3 . . . a n = b 1 b 2 b 3 . . . b n + 1 0 0 ... 0 - b 1 1 0 ... 0 - b 2 - b 1 1 ... 0 . . . . . . . . . . . . . . . - b n - 1 - b n - 2 - b n - 3 ... - b n - 1 .
步骤3中,狼群算法优化ARMA模型中的参数,具体步骤如下:
步骤3-1,数值初始化:设置人工狼的个数L,最大迭代次数M,距离判定因子w=500,更新比例因子β=6;
步骤3-2,初始化人工狼位置:以长自回归法求解的自回归移动平均ARMA模型参数中的残差为中心进行扩展,人工狼向h个方向进行探索,在探索区间内随机生成L匹人工狼初始位置i=1,2,…,L;
步骤3-3,设人工狼位置拟合的残差序列为j=1,2,…,M,残差序列的方差为且为目标函数,寻求目标函数最小值;
步骤3-4,选取具有最优函数值的人工狼为头狼,除头狼外具有最优函数值的S匹人工狼为探狼,探狼i首先感知空气中的猎物气味,即计算该探狼当前位置的猎物气味浓度Yi,若一只探狼侦查到猎物气味浓度yi大于头狼感知的浓度ylead,则ylead=yi,探狼i替代头狼并发起召唤行为;若yi<ylead,则探狼先自主决策,即探狼向h个方向分别前进一步,此时的步长称为游走步长stepa,并记录每前进一步后所感知的猎物气味浓度后退回原位置,则向第i个方向前进后探狼在第d维变量空间中所处的位置为:
x i d p = x i d + s i n ( 2 &pi; &times; p / h ) &times; step a d ,
其中xid为第i匹探狼在欲寻优的第d维变量空间中所处位置,表示探狼在第d维变量空间中的步长,表示第i匹探狼在第d维变量空间中向第p个方向前进后的位置,p=1,2,…,h,
此时,探狼所感知的猎物气味浓度为yip,选择气味最浓的且大于当前位置气味浓度yi0的方向前进一步,更新探狼的位置xid,重复以上的游走行为直到一匹探狼感知到的猎物气味浓度yi>ylead或游走次数M达到最大游走次数Mmax,转步骤3-5;
步骤3-5,猛狼根据式如下公式向猎物奔袭:
x i d k + 1 = x i d k + step b d &CenterDot; ( g d k - x i d k ) / | g d k - x i d k | ,
式中,为第k代群体头狼在第d维变量空间中的位置,表示猛狼在第d维变量空间中的步长,当猛狼感知的猎物气味浓度yi>ylead时,则yi=ylead,猛狼代头狼发起召唤行为;否则,转步骤3-6;
步骤3-6,按如下公式对参与围攻行为的猛狼位置进行更新,同时发起围攻行为:
x i d k + 1 = x i d k + &lambda; &CenterDot; step i d &CenterDot; | G d k - x i d k | ,
式中,λ为[-1,1]间均匀分布的随机数;为猛狼i执行围攻行为时的攻击步长,为猎物在第d维变量空间中的位置,第i匹探狼在第d维变量空间中向第k个方向前进后的位置,
按胜者为王的头狼产生机制即最先围攻到猎物的猛狼为头狼,对头狼位置进行更新,转步骤3-7;
步骤3-7,判断是否达到目标函数要求的优化精度或最大迭代次数,若是,输出头狼位置,即问题的最优解;否则,转步骤3-4,继续循环。
步骤4中所述补偿电路包括微处理电路、驱动频率提取电路以及温度补偿电路。
所述微处理电路包括微处理器以及数模转换处理电路,微处理器用于将经过电压比较器后输出的方波信号上升沿计数,得到频率信号,还用于存储补偿模型并输出补偿的数字信号,通过数模转换处理电路将数字信号转换为模拟输出信号。
所述驱动频率提取电路包括一组电压比较器,该电压比较器将提取的与陀螺仪谐振频率相关的正弦号转换成方波信号,然后送入单片机。
所述温度补偿电路为加法电路,当温度系数为正时,数字电路补偿环节采取负温度系数进行补偿,当温度系数为负时,数字电路补偿环节采取正温度系数进行补偿。
有益效果:
本发明针对硅材料的特点导致硅微陀螺仪受温度影响较大的特性,设计了一种基于微处理器的硅微陀螺仪温度补偿方法,利用群狼算法具有较好的鲁棒性以及全局收敛性,可有效避免常用智能算法所出现的算法早熟收敛问题,有效拓展硅微陀螺仪温度误差模型在工程上的应用,具有一定实际意义。
附图说明
下面结合附图和具体实施方式对本发明做更进一步的具体说明,本发明的上述和/或其他方面的优点将会变得更加清楚。
图1为本发明结构示意图。
图2为本发明狼群算法流程图。
图3为本发明狼群算法结果图。
具体实施方式
下面结合附图和实施例,对本发明作更进一步的详细说明。
如图1与图2所示,本实施例基于微处理器的硅微陀螺温度补偿方法,按如下步骤进行:
步骤1,在硅微陀螺仪测控电路中选取接入点,加入数字电路补偿环节,即设置硅微陀螺仪零偏补偿点;
步骤2,将狼群算法和自回归移动平均ARMA模型参数初始化,对测试所得数据进行去噪和去除趋势项预处理,并根据所得输出数据确定自回归移动平均ARMA模型;
步骤3,利用步骤2所得的样本数据训练自回归移动平均ARMA模型,通过最小二乘法来确定自回归移动平均ARMA模型中的参数,并用狼群算法优化自回归移动平均ARMA模型中的参数;
步骤4,根据训练好的自回归移动平均ARMA模型预测硅微陀螺的输出并进行温度漂移误差的补偿,得到补偿模型;
步骤5,将补偿模型存入单片机中,将补偿电路设计入整个硅微陀螺仪测控电路中。
其特征在于,步骤1中,将硅微陀螺仪零偏补偿点设置在硅微陀螺仪的最后一级输出上。
步骤3中,自回归移动平均ARMA模型表达式为:
x r + &Sigma; s = 1 n a s x r - s = e r + &Sigma; t = 1 m b t e r - t , e r - t ~ N ( 0 , &sigma; 2 ) ,
上述表达式反映了输出数据序列xr与输入数据序列xr-s的对应关系,等式的左边是自回归差分多项式模型,其阶次为n;右边是滑动平均差分多项式模型,其阶次为m;n、m范围上线是输入数据个数u较小时取u的比例,u较大时取logu的倍数;as、bt分别表示第s个待识别的自回归系数与第t个滑动均值系数;er表示第r个残差;{er-t}序列为白噪声激励;N表示正态分布;σ2为随机变量的方差;er-t~N(0,σ2)表示er-t服从均数为0,标准差为σ的正态分布。
步骤3中,待识别的自回归系数as的最小二乘估计如下:
a ^ s = ( x T x ) - 1 x T y ,
其中,是待识别的自回归系数as的无偏估计,y=[xn+1 xn+2…xN],xN表示响应输出数据序列,其中as=[a1 a2…an],an表示第n个待识别的自回归系数,
x = x n x n - 1 ... x 1 x n + 1 x n ... x 2 . . . . . . . . . x N - 1 x N - 2 ... x N - n .
步骤3中,使用长自回归模型法,待识别的自回归系数as的最小二乘估计如下式所示:
as=-bnIn-m-…-b2In-2-b1In-1+In
其中In表示n阶单位矩阵,bn表示第n个滑动均值系数,
通过下式计算关于的bt线性方程组,得到待识别的自回归系数as的无偏估计
I n + 1 I n + 2 . . . I n + m = I n I n - 1 I n - 2 ... I n + 1 - m I n + 1 I n I n - 1 ... I n + 2 - m . . . . . . . . . . . . . . . I n + m - 1 I n = m - 2 I n + m - 3 ... I n b 1 b 2 . . . b m ,
再通过如下公式计算关于ak的线性方程组,求出滑动均值系数
a 1 a 2 a 3 . . . a n = b 1 b 2 b 3 . . . b n + 1 0 0 ... 0 - b 1 1 0 ... 0 - b 2 - b 1 1 ... 0 . . . . . . . . . . . . . . . - b n - 1 - b n - 2 - b n - 3 ... - b n - 1 .
步骤3中,狼群算法优化ARMA模型中的参数,具体步骤如下:
步骤3-1,数值初始化:设置人工狼的个数L,最大迭代次数M,距离判定因子w=500,更新比例因子β=6;
步骤3-2,初始化人工狼位置:以长自回归法求解的自回归移动平均ARMA模型参数中的残差为中心进行扩展,人工狼向h个方向进行探索,在探索区间内随机生成L匹人工狼初始位置i=1,2,…,L;
步骤3-3,设人工狼位置拟合的残差序列为j=1,2,…,M,残差序列的方差为且为目标函数,寻求目标函数最小值;
步骤3-4,选取具有最优函数值的人工狼为头狼,除头狼外具有最优函数值的S匹人工狼为探狼,探狼i首先感知空气中的猎物气味,即计算该探狼当前位置的猎物气味浓度Yi,若一只探狼侦查到猎物气味浓度yi大于头狼感知的浓度ylead,则ylead=yi,探狼i替代头狼并发起召唤行为;若yi<ylead,则探狼先自主决策,即探狼向h个方向分别前进一步,此时的步长称为游走步长stepa,并记录每前进一步后所感知的猎物气味浓度后退回原位置,则向第i个方向前进后探狼在第d维变量空间中所处的位置为:
x i d p = x i d + s i n ( 2 &pi; &times; p / h ) &times; step a d ,
其中xid为第i匹探狼在欲寻优的第d维变量空间中所处位置,表示探狼在第d维变量空间中的步长,表示第i匹探狼在第d维变量空间中向第p个方向前进后的位置,p=1,2,…,h,
此时,探狼所感知的猎物气味浓度为yip,选择气味最浓的且大于当前位置气味浓度yi0的方向前进一步,更新探狼的位置xid,重复以上的游走行为直到一匹探狼感知到的猎物气味浓度yi>ylead或游走次数M达到最大游走次数Mmax,转步骤3-5;
步骤3-5,猛狼根据式如下公式向猎物奔袭:
x i d k + 1 = x i d k + step b d &CenterDot; ( g d k - x i d k ) / | g d k - x i d k | ,
式中,为第k代群体头狼在第d维变量空间中的位置,表示猛狼在第d维变量空间中的步长,当猛狼感知的猎物气味浓度yi>ylead时,则yi=ylead,猛狼代头狼发起召唤行为;否则,转步骤3-6;
步骤3-6,按如下公式对参与围攻行为的猛狼位置进行更新,同时发起围攻行为:
x i d k + 1 = x i d k + &lambda; &CenterDot; step i d &CenterDot; | G d k - x i d k | ,
式中,λ为[-1,1]间均匀分布的随机数;为猛狼i执行围攻行为时的攻击步长,为猎物在第d维变量空间中的位置,第i匹探狼在第d维变量空间中向第k个方向前进后的位置,
按胜者为王的头狼产生机制即最先围攻到猎物的猛狼为头狼,对头狼位置进行更新,转步骤3-7;
步骤3-7,判断是否达到目标函数要求的优化精度或最大迭代次数,若是,输出头狼位置,即问题的最优解;否则,转步骤3-4,继续循环。
步骤4中所述补偿电路包括微处理电路、驱动频率提取电路以及温度补偿电路。
所述微处理电路包括微处理器以及数模转换处理电路,微处理器用于将经过电压比较器后输出的方波信号上升沿计数,得到频率信号,还用于存储补偿模型并输出补偿的数字信号,通过数模转换处理电路将数字信号转换为模拟输出信号。
所述驱动频率提取电路包括一组电压比较器,该电压比较器将提取的与陀螺仪谐振频率相关的正弦号转换成方波信号,然后送入单片机。
所述温度补偿电路为加法电路,当温度系数为正时,数字电路补偿环节采取负温度系数进行补偿,当温度系数为负时,数字电路补偿环节采取正温度系数进行补偿。
下面结合实例来进行进一步说明:
为了得到硅微陀螺的输出数据,将陀螺放置在可控温控箱中,将温控箱按照1℃/min的速率从+85℃降至-55℃,期间按照1s一个点进行数据采集,一共需要2h20min,然后运用狼值算法进行参数模型的确定。将该模型存入单片机中进行仿真实验,得到实验前后数据如图3所示,从表中可以看出本发明可以较好的补偿硅微陀螺仪输出漂移,为提高硅微陀螺仪精度提供了一个可行的方法。

Claims (10)

1.一种基于微处理器的硅微陀螺仪温度补偿方法,其特征在于,包括如下步骤:
步骤1,在硅微陀螺仪测控电路中选取接入点,加入数字电路补偿环节,即设置硅微陀螺仪零偏补偿点;
步骤2,将狼群算法和自回归移动平均模型参数初始化,对加入补偿环节前的陀螺实验所测得数据进行去噪和去除趋势项预处理,并根据所得输出数据确定自回归移动平均模型;
步骤3,利用步骤2所得的输出数据训练自回归移动平均模型,通过最小二乘法来确定自回归移动平均模型中的参数,并用狼群算法优化自回归移动平均模型中的参数;
步骤4,根据训练好的自回归移动平均模型预测硅微陀螺的输出并进行温度漂移误差的补偿,得到补偿模型;
步骤5,将补偿模型存入单片机中,将补偿电路设计入整个硅微陀螺仪测控电路中。
2.如权利要求1所述的方法,其特征在于,步骤1中,将硅微陀螺仪零偏补偿点设置在硅微陀螺仪的最后一级输出上。
3.如权利要求2所述的方法,其特征在于,步骤3中,自回归移动平均模型表达式为:
x r + &Sigma; s = 1 n a s x r - s = e r + &Sigma; t = 1 m b t e r - t , e r - t ~ N ( 0 , &sigma; 2 ) ,
上述表达式反映了输出数据序列xr与输入数据序列xr-s的对应关系,等式的左边是自回归差分多项式模型,其阶次为n;右边是滑动平均差分多项式模型,其阶次为m;as、bt分别表示第s个待识别的自回归系数与第t个滑动均值系数;er表示第r个残差;{er-t}序列为白噪声激励;N表示正态分布;σ2为随机变量的方差;er-t~N(0,σ2)表示er-t服从均数为0、标准差为σ的正态分布。
4.如权利要求3所述的方法,其特征在于,步骤3中,待识别的自回归系数as的最小二乘估计如下:
a ^ s = ( x T x ) - 1 x T y ,
其中,是待识别的自回归系数as的无偏估计,y=[xn+1 xn+2 … xN],xN表示响应输出数据序列,其中as=[a1 a2 … an],an表示第n个待识别的自回归系数,
5.如权利要求4所述的方法,其特征在于,步骤3中,使用长自回归模型法,待识别的自回归系数as的最小二乘估计如下式所示:
as=-bnIn-m-…-b2In-2-b1In-1+In
其中In表示n阶单位矩阵,bn表示第n个滑动均值系数,
通过下式计算关于的bt线性方程组,得到待识别的自回归系数as的无偏估计
I n + 1 I n + 2 . . . I n + m = I n I n - 1 I n - 2 ... I n + 1 - m I n + 1 I n I n - 1 ... I n + 2 - m . . . . . . . . . . . . . . . I n + m - 1 I n = m - 2 I n + m - 3 ... I n b 1 b 2 . . . b m ,
再通过如下公式计算关于的线性方程组,求出滑动均值系数
a 1 a 2 a 3 . . . a n = b 1 b 2 b 3 . . . b n + 1 0 0 ... 0 - b 1 1 0 ... 0 - b 2 - b 1 1 ... 0 . . . . . . . . . . . . . . . - b n - 1 - b n - 2 - b n - 3 ... - b n - 1 .
6.如权利要求5所述的方法,其特征在于,步骤3中,狼群算法优化自回归移动平均模型中的参数,具体步骤如下:
步骤3-1,数值初始化:设置人工狼的个数L,最大迭代次数M,距离判定因子w=500,更新比例因子β=6;
步骤3-2,初始化人工狼位置:以长自回归法求解的自回归移动平均模型参数中的残差为中心进行扩展,人工狼向h个方向进行探索,在探索区间内随机生成L匹人工狼初始位置i=1,2,…,L;
步骤3-3,设人工狼位置拟合的残差序列为j=1,2,…,M,残差序列的方差为且为目标函数,寻求目标函数最小值;
步骤3-4,选取具有最优函数值的人工狼为头狼,除头狼外具有最优函数值的S匹人工狼为探狼,探狼i首先感知空气中的猎物气味,即计算该探狼当前位置的猎物气味浓度Yi,若一只探狼侦查到猎物气味浓度yi大于头狼感知的浓度ylead,则ylead=yi,探狼i替代头狼并发起召唤行为;若yi<ylead,则探狼先自主决策,即探狼向h个方向分别前进一步,此时的步长称为游走步长stepa,并记录每前进一步后所感知的猎物气味浓度后退回原位置,则向第i个方向前进后探狼在第d维变量空间中所处的位置为:
x i d p = x i d + s i n ( 2 &pi; &times; p / h ) &times; step a d ,
其中xid为第i匹探狼在欲寻优的第d维变量空间中所处位置,表示探狼在第d维变量空间中的步长,表示第i匹探狼在第d维变量空间中向第p个方向前进后的位置,p=1,2,…,h,
此时,探狼所感知的猎物气味浓度为yip,选择气味最浓的且大于当前位置气味浓度yi0的方向前进一步,更新探狼的位置xid,重复以上的游走行为直到一匹探狼感知到的猎物气味浓度yi>ylead或游走次数M达到最大游走次数Mmax,转步骤3-5;
步骤3-5,猛狼根据式如下公式向猎物奔袭:
x i d k + 1 = x i d k + step b d &CenterDot; ( g d k - x i d k ) / | g d k - x i d k | ,
式中,为第k代群体头狼在第d维变量空间中的位置,表示猛狼在第d维变量空间中的步长,当猛狼感知的猎物气味浓度yi>ylead时,则yi=ylead,猛狼代头狼发起召唤行为;否则,转步骤3-6;
步骤3-6,按如下公式对参与围攻行为的猛狼位置进行更新,同时发起围攻行为:
x i d k + 1 = x i d k + &lambda; &CenterDot; step i d &CenterDot; | G d k - x i d k | ,
式中,λ为[-1,1]间均匀分布的随机数;为猛狼i执行围攻行为时的攻击步长,为猎物在第d维变量空间中的位置,第i匹探狼在第d维变量空间中向第k个方向前进后的位置,
按胜者为王的头狼产生机制即最先围攻到猎物的猛狼为头狼,对头狼位置进行更新,转步骤3-7;
步骤3-7,判断是否达到目标函数要求的优化精度或最大迭代次数,若是,输出头狼位置,即问题的最优解;否则,转步骤3-4,继续循环。
7.如权利要求1所述的方法,其特征在于,步骤4中所述补偿电路包括微处理电路、驱动频率提取电路以及温度补偿电路。
8.如权利要求7所述的方法,其特征在于,所述微处理电路包括微处理器以及数模转换处理电路,微处理器用于将经过电压比较器后输出的方波信号上升沿计数,得到频率信号,还用于存储补偿模型并输出补偿的数字信号,通过数模转换处理电路将数字信号转换为模拟输出信号。
9.如权利要求8所述的方法,其特征在于,所述驱动频率提取电路包括一组电压比较器,该电压比较器将提取的与陀螺仪谐振频率相关的正弦号转换成方波信号,然后送入单片机。
10.如权利要求9所述的方法,其特征在于,所述温度补偿电路为加法电路,当温度系数为正时,数字电路补偿环节采取负温度系数进行补偿,当温度系数为负时,数字电路补偿环节采取正温度系数进行补偿。
CN201610395990.2A 2016-06-06 2016-06-06 一种基于微处理器的硅微陀螺仪温度补偿方法 Pending CN106092138A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610395990.2A CN106092138A (zh) 2016-06-06 2016-06-06 一种基于微处理器的硅微陀螺仪温度补偿方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610395990.2A CN106092138A (zh) 2016-06-06 2016-06-06 一种基于微处理器的硅微陀螺仪温度补偿方法

Publications (1)

Publication Number Publication Date
CN106092138A true CN106092138A (zh) 2016-11-09

Family

ID=57448459

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610395990.2A Pending CN106092138A (zh) 2016-06-06 2016-06-06 一种基于微处理器的硅微陀螺仪温度补偿方法

Country Status (1)

Country Link
CN (1) CN106092138A (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107368076A (zh) * 2017-07-31 2017-11-21 中南大学 一种智能环境下机器人运动路径深度学习控制规划方法
CN108422997A (zh) * 2018-05-15 2018-08-21 南京航空航天大学 一种基于狼群算法的汽车主动安全协同控制系统及方法
CN109633205A (zh) * 2019-01-16 2019-04-16 南京理工大学 一种石英谐振加速度计温度补偿方法
CN109974750A (zh) * 2018-12-11 2019-07-05 中国航空工业集团公司北京长城计量测试技术研究所 一种基于模糊逻辑系统的环形激光器温度建模及补偿方法
CN110375649A (zh) * 2019-08-05 2019-10-25 安徽工业大学 一种柔性臂坐标测量机的圆光栅偏心参数标定方法
CN110749307A (zh) * 2019-12-03 2020-02-04 国家电网有限公司 基于北斗定位的输电线路位移沉降判定方法及系统
CN111521288A (zh) * 2020-04-14 2020-08-11 三峡大学 一种利用狼群算法的fbg非均匀温度重构方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1687707A (zh) * 2005-06-07 2005-10-26 中国航天时代电子公司 光纤陀螺惯测装置快速启动和精度保证的工程实现方法
CN102650527A (zh) * 2012-05-25 2012-08-29 北京航空航天大学 一种基于时间序列分析消噪的光纤陀螺温度补偿方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1687707A (zh) * 2005-06-07 2005-10-26 中国航天时代电子公司 光纤陀螺惯测装置快速启动和精度保证的工程实现方法
CN102650527A (zh) * 2012-05-25 2012-08-29 北京航空航天大学 一种基于时间序列分析消噪的光纤陀螺温度补偿方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
来凌红: "基于ARMA模型和狼群算法的陀螺随机漂移建模研究", 《传感器与微系统》 *

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107368076A (zh) * 2017-07-31 2017-11-21 中南大学 一种智能环境下机器人运动路径深度学习控制规划方法
CN107368076B (zh) * 2017-07-31 2018-03-27 中南大学 一种智能环境下机器人运动路径深度学习控制规划方法
CN108422997A (zh) * 2018-05-15 2018-08-21 南京航空航天大学 一种基于狼群算法的汽车主动安全协同控制系统及方法
CN109974750A (zh) * 2018-12-11 2019-07-05 中国航空工业集团公司北京长城计量测试技术研究所 一种基于模糊逻辑系统的环形激光器温度建模及补偿方法
CN109974750B (zh) * 2018-12-11 2020-10-02 中国航空工业集团公司北京长城计量测试技术研究所 一种基于模糊逻辑系统的环形激光器温度建模及补偿方法
CN109633205A (zh) * 2019-01-16 2019-04-16 南京理工大学 一种石英谐振加速度计温度补偿方法
CN109633205B (zh) * 2019-01-16 2020-12-04 南京理工大学 一种石英谐振加速度计温度补偿方法
CN110375649A (zh) * 2019-08-05 2019-10-25 安徽工业大学 一种柔性臂坐标测量机的圆光栅偏心参数标定方法
CN110749307A (zh) * 2019-12-03 2020-02-04 国家电网有限公司 基于北斗定位的输电线路位移沉降判定方法及系统
CN111521288A (zh) * 2020-04-14 2020-08-11 三峡大学 一种利用狼群算法的fbg非均匀温度重构方法

Similar Documents

Publication Publication Date Title
CN106092138A (zh) 一种基于微处理器的硅微陀螺仪温度补偿方法
CN111896026B (zh) 固态谐振陀螺自校准方法及系统
CN103940427B (zh) 一种mems惯性测量单元冷启动时温度误差补偿方法
CN110749337B (zh) 一种基于深度神经网络的mimu误差补偿方法
US5699253A (en) Nonlinear dynamic transform for correction of crankshaft acceleration having torsional oscillations
CN108645427A (zh) 基于样条插值迭代修正的激光惯组系统级温度补偿方法
CN103499345B (zh) 一种基于小波分析和bp神经网络的光纤陀螺温度漂移补偿方法
CN106370173B (zh) 一种激光陀螺仪温度补偿模型的建模和验证方法
CN104573248B (zh) 基于emd的光纤陀螺温度漂移多尺度极限学习机训练方法
CN103344257B (zh) 一种惯性测量单元的快速温度标定方法
CN110375726A (zh) 一种光纤陀螺系统级温度补偿方法、装置和光纤惯导系统
CN110553642B (zh) 一种提高惯性制导精度的方法
CN109323711A (zh) 一种陀螺仪模态反转零位自校正方法及系统
CN105043348A (zh) 基于卡尔曼滤波的加速度计陀螺仪水平角度测量方法
CN109188026A (zh) 适用于mems加速度计的自动标定的深度学习方法
CN109297509A (zh) 一种基于三态理论的激光陀螺零偏漂移误差建模与补偿方法
CN107831660A (zh) 微陀螺仪自适应高阶超扭曲滑模控制方法
CN112762962B (zh) 基于温度滞后模型的微机电系统加速度计零偏补偿方法
CN111879348B (zh) 一种惯性仪表性能地面测试系统效能分析方法
Zhang et al. Performance analysis of adaptive neuro fuzzy inference system control for MEMS navigation system
CN110595508A (zh) 一种光纤陀螺标度因数误差补偿方法
CN108107233A (zh) 加速度计标度因数的连续温度校正方法及系统
CN102741768B (zh) 预测未来时间间隔的持续时间的方法和产生其的电路装置
Vance et al. Output feedback controller for operation of spark ignition engines at lean conditions using neural networks
RU2758339C1 (ru) Способ компенсации температурных погрешностей инерциального измерительного блока систем ориентации и навигации

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20161109