CN112611887B - 一种基于模型参数辨识的陀螺加速度计输出补偿方法 - Google Patents
一种基于模型参数辨识的陀螺加速度计输出补偿方法 Download PDFInfo
- Publication number
- CN112611887B CN112611887B CN202011462326.8A CN202011462326A CN112611887B CN 112611887 B CN112611887 B CN 112611887B CN 202011462326 A CN202011462326 A CN 202011462326A CN 112611887 B CN112611887 B CN 112611887B
- Authority
- CN
- China
- Prior art keywords
- acceleration
- gyro
- accelerometer
- gyro accelerometer
- output
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
- G01P15/14—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of gyroscopes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
- G01P15/18—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration in two or more dimensions
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
Abstract
Description
技术领域
本发明属于高精度视加速度测量技术领域,涉及一种惯性稳定平台用的加速度计导航解算,特别涉及一种基于模型参数辨识的陀螺加速度计输出补偿方法。
背景技术
在高精度惯性稳定平台中,目前主要采用石英挠性加速度计和摆式积分陀螺加速度计,二者都为单自由度加速度计,每个加速度计都是敏感一个方向的视加速度。
摆式积分陀螺加速度计(PIGA)是一种利用陀螺力矩进行反馈的摆式加速度计,其工作原理见下图1。图中,OX0Y0Z0为与外框架相固连的坐标系,OX0为输入轴;Oxyz为莱差坐标系,Oz轴与转子轴重合;分别为外框架相对仪表基座(摆式积分陀螺加速度计的壳体)和内框架相对外框架的角速度;ax为仪表沿外框架轴输入的视加速度;ml为仪表沿内框架轴的摆性;H为仪表转子的角动量;Mx为绕外框架轴的各种干扰力矩之和;MD为电机力矩。图中还包括:1—角度传感器,2—放大器,3—力矩电机,4—输出装置。
由图1可知,这种陀螺加速度计在结构上与二自由度陀螺仪类似:有高速旋转的陀螺转子,有内、外框架。内框架轴的一端装有角度传感器,外框架轴的上下端分别装有输出装置和力矩电机。沿转子轴Oz有一偏心质量m,其质心离内框架轴的距离为l,因而绕内框架轴形成摆性ml。
当仪表沿外框架轴OX0方向有视加速度ax时,在内框架轴上产生与该视加速度成正比的惯性力矩mlax。在理想情况下,即沿内、外框架轴没有任何干扰力矩的情况下,按陀螺进动原理,转子将带动内、外框架一起绕OX0轴进动,其进动角速度为由于进动的结果,内框架轴上产生陀螺反作用力矩在稳态条件下,惯性力矩mlax将精确地被陀螺力矩所平衡,因此有 或者在零初始条件下,有理想的输出值:
为了保证H与外框架轴OX的垂直,陀螺加速度计还增加了一个伺服回路,当受到干扰力矩Mx的影响,内框架角度β不为0时,角度传感器就会输出相应的电压信号,经过放大和变换后,馈向力矩电机,使其产生一个电机力矩MDx以抵消Mx。可以看出,伺服回路的传感器为内框架角度传感器,测量值为β。虽然伺服回路可使角度传感器的测量值β保持为零,但当该角度传感器的机械零位存在偏差时,并不能保证转子轴Oz与外框架轴OX相互垂直,为此,统一把这种不垂直角度用β表示。此时,陀螺加速度计的输出方程为:
但该简化方法会引起陀螺加速度计的测量误差,从而会影响仪表的使用精度,直接导致导弹的导航与制导存在落点误差。
为进一步构建陀螺加速度计的测量误差模型,通过误差补偿提高使用精度,本发明提出了一种基于模型参数辨识的陀螺加速度计输出补偿方法,以提高陀螺加速度计的视加速度精确测量能力。
发明内容
为了克服现有技术中的不足,本发明人进行了锐意研究,提供了一种基于模型参数辨识的陀螺加速度计输出补偿方法,根据时变输入加速度ax、横向加速度的大小,分理出不垂直角度β以及初始相位角,采用误差补偿的方法计算出陀螺加速度计的真实加速度输出值,输出值具有较高的精度。
本发明提供的技术方案如下:
一种基于模型参数辨识的陀螺加速度计输出补偿方法,包括如下步骤:
步骤(3),陀螺加速度计的输出模型为:
式中,m为陀螺加速度计的转子偏心质量,l为转子偏心距离,H为仪表转子角动量;a′x为根据步骤(2)中的转动角速度解算的加速度;β为陀螺加速度计的外框架轴和转子轴的不垂直角度;φ为时间为0时的初始相位角;
(4)通过比较a′x和ax的差值标定出参数tanβ和φ,具体方法如下:
(4.1)把参数tanβ和φ写为2维的状态变量:
y(tn)=a′x(tn)-ax(tn) 式6
P(tn)=P(tn-1)-K(tn)H(tn)P(tn-1) 式9
(4.4)由步骤(4.3)可求得tn时刻的参数tanβ和φ;
根据本发明提供的一种基于模型参数辨识的陀螺加速度计输出补偿方法,具有以下有益效果:
附图说明
图1为陀螺加速度计的原理示意图;
图2为本发明的陀螺加速度计输出计算流程图;
图3为示例1中陀螺加速度计基座轴X0、Y0受到的过载值;
图4为示例1中陀螺加速度计原加速度计算值;
图5为示例1中陀螺加速度计采用原计算方法引起的加速度误差;
图6为示例1中陀螺加速度计输出模型参数迭代计算过程;
图7为示例1中采用本发明补偿后的加速度计算值;
图8为示例1中陀螺加速度计经补偿后加速度的计算误差。
具体实施方式
下面通过对本发明进行详细说明,本发明的特点和优点将随着这些说明而变得更为清楚、明确。
本发明提供了一种基于模型参数辨识的陀螺加速度计输出补偿方法,如图2所示,包括如下步骤:
步骤(3),陀螺加速度计的输出模型为:
式中,m为陀螺加速度计的转子偏心质量,l为转子偏心距离,H为仪表转子角动量;a′x为根据步骤(2)中的转动角速度解算的加速度;β为陀螺加速度计的外框架轴和转子轴的不垂直角度;φ为时间为0时的初始相位角。
上式所示的输出模型为一个非线性方程,式中,tanβ和φ为待估计的参数。
(4)通过比较a′x和ax的差值标定出参数tanβ和φ,具体方法如下:
(4.1)把参数tanβ和φ写为2维的状态变量:
y(tn)=a′x(tn)-ax(tn) 式6
P(tn)=P(tn-1)-K(tn)H(tn)P(tn-1) 式9
(4.4)由步骤(4.3)可求得tn时刻的参数tanβ和φ;
所述步骤(5)中,在每个递推时刻,利用实时估计的参数对陀螺加速度计的输出值进行修正,进而实现对加速度计的在线补偿,有效提高了陀螺加速度计的使用精度。
在本发明中,步骤(1)中,陀螺加速度计的陀螺转子可以采用动压气浮、液浮支撑等方式实现,陀螺加速度计的偏性摆性结构可以由偏心式摆结构、移轴式摆结构等方式实现,陀螺加速度计测量的载体可以为飞机、轮船、机动车辆、导弹等。
实施例
实施例1
设β=1000″,对应的tanβ为4.848×10-3;φ=45.98°=0.802rad,当理论加速度为时变过载时,如图3所示,二者满足关系式如果按照陀螺加速度计原来的计算公式进行计算,其输出加速度如图4所示;与图3作比较,其与理论加速度值的差值如图5所示,可以看出,误差为交变量,随着加速度的增大,误差的幅值变大,最大加速度误差可达0.05g。
设初值采用本发明迭代计算的陀螺加速度计输出模型参数结果如图6所示。补偿后计算的结果如图7所示;二者的差值如图8所示,最大加速度误差接近0.0015g。可以看出,经本发明补偿后的陀螺加速度计输出结果更准确。
以上结合具体实施方式和范例性实例对本发明进行了详细说明,不过这些说明并不能理解为对本发明的限制。本领域技术人员理解,在不偏离本发明精神和范围的情况下,可以对本发明技术方案及其实施方式进行多种等价替换、修饰或改进,这些均落入本发明的范围内。本发明的保护范围以所附权利要求为准。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (5)
1.一种基于模型参数辨识的陀螺加速度计输出补偿方法,其特征在于,包括如下步骤:
步骤(3),陀螺加速度计的输出模型为:
式中,m为陀螺加速度计的转子偏心质量,l为转子偏心距离,H为陀螺加速度计转子角动量;a′x为根据步骤(2)中的转动角速度解算的加速度;β为陀螺加速度计的外框架轴和转子轴的不垂直角度;φ为时间为0时的初始相位角;
(4)通过比较a′x和ax的差值标定出参数tanβ和φ,具体方法如下:
(4.1)把参数tanβ和φ写为2维的状态变量:
y(tn)=a′x(tn)-ax(tn) 式6
P(tn)=P(tn-1)-K(tn)H(tn)P(tn-1) 式9
(4.4)由步骤(4.3)可求得tn时刻的参数tanβ和φ;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011462326.8A CN112611887B (zh) | 2020-12-11 | 2020-12-11 | 一种基于模型参数辨识的陀螺加速度计输出补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011462326.8A CN112611887B (zh) | 2020-12-11 | 2020-12-11 | 一种基于模型参数辨识的陀螺加速度计输出补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112611887A CN112611887A (zh) | 2021-04-06 |
CN112611887B true CN112611887B (zh) | 2022-09-27 |
Family
ID=75234498
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011462326.8A Active CN112611887B (zh) | 2020-12-11 | 2020-12-11 | 一种基于模型参数辨识的陀螺加速度计输出补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112611887B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113865583B (zh) * | 2021-07-20 | 2024-02-09 | 北京航天控制仪器研究所 | 一种加速度计组合动态安装偏差矩阵确定及补偿方法 |
CN113686356B (zh) * | 2021-08-03 | 2023-04-28 | 中国船舶重工集团公司第七0七研究所 | 基于rbf网络的谐振陀螺零偏在线自补偿系统及方法 |
CN114413886B (zh) * | 2021-12-24 | 2024-01-02 | 上海航天控制技术研究所 | 一种星载加速度计组合零位补偿方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004233306A (ja) * | 2003-01-31 | 2004-08-19 | Japan Aviation Electronics Industry Ltd | 加速度誤差演算装置並びに加速度計出力補正装置および加速度計出力補正方法 |
CN106767925A (zh) * | 2016-12-29 | 2017-05-31 | 西安航天精密机电研究所 | 带双轴转位机构的惯导系统三位置参数辨识对准方法 |
CN108710001A (zh) * | 2018-04-28 | 2018-10-26 | 北京航天控制仪器研究所 | 一种两轴一体陀螺加速度计及伺服控制方法 |
CN109029502A (zh) * | 2018-07-27 | 2018-12-18 | 北京航天控制仪器研究所 | 一种惯性平台系统石英加速度计输出值确定方法 |
CN111024074A (zh) * | 2019-12-12 | 2020-04-17 | 北京遥测技术研究所 | 一种基于递推最小二乘参数辨识的惯导速度误差确定方法 |
-
2020
- 2020-12-11 CN CN202011462326.8A patent/CN112611887B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004233306A (ja) * | 2003-01-31 | 2004-08-19 | Japan Aviation Electronics Industry Ltd | 加速度誤差演算装置並びに加速度計出力補正装置および加速度計出力補正方法 |
CN106767925A (zh) * | 2016-12-29 | 2017-05-31 | 西安航天精密机电研究所 | 带双轴转位机构的惯导系统三位置参数辨识对准方法 |
CN108710001A (zh) * | 2018-04-28 | 2018-10-26 | 北京航天控制仪器研究所 | 一种两轴一体陀螺加速度计及伺服控制方法 |
CN109029502A (zh) * | 2018-07-27 | 2018-12-18 | 北京航天控制仪器研究所 | 一种惯性平台系统石英加速度计输出值确定方法 |
CN111024074A (zh) * | 2019-12-12 | 2020-04-17 | 北京遥测技术研究所 | 一种基于递推最小二乘参数辨识的惯导速度误差确定方法 |
Non-Patent Citations (1)
Title |
---|
陀螺加速度计在精密线振动台上的测试方法及误差分析;师少龙;《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》;20170215;28-29 * |
Also Published As
Publication number | Publication date |
---|---|
CN112611887A (zh) | 2021-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112611887B (zh) | 一种基于模型参数辨识的陀螺加速度计输出补偿方法 | |
CN106052682B (zh) | 一种混合式惯性导航系统及导航方法 | |
CN108710001B (zh) | 一种两轴一体陀螺加速度计及伺服控制方法 | |
CN111780752B (zh) | 一种姿态误差可观测的提高惯性制导精度方法 | |
US3279086A (en) | Compensated gyroscopic directional reference | |
CN110068336A (zh) | 一种基于磁悬浮控制敏感陀螺平行构型的角运动测量方法 | |
US4275605A (en) | Acceleration sensitive gyroscope stabilized platform | |
CN111006663B (zh) | 一种基于serf陀螺仪和速率陀螺仪的三轴惯性平台系统 | |
EP2638360B1 (en) | A system and method for north finding | |
CN111637883B (zh) | 基于速度和位置误差闭环反馈的提高惯性制导精度的方法 | |
CN111006665B (zh) | 一种基于磁场反馈的原子自旋陀螺仪捷联系统 | |
Jianli et al. | Fuzzy modeling and compensation of scale factor for MEMS gyroscope | |
CN113029140A (zh) | 一种基于地心惯性系的捷联惯导系统三轴旋转调制方法 | |
Sushchenko | Mathematical model of triaxial multimode attitude and heading reference system | |
CN112729335A (zh) | 一种适用于晃动基座的惯性/星光组合导航系统标定方法 | |
CN112630471B (zh) | 一种陀螺加速度计的输出补偿方法 | |
US7065891B2 (en) | Accelerometer augmented precision compass | |
CN112557699B (zh) | 一种时变加速度引起的陀螺加速度计输出测定方法 | |
CN113865585B (zh) | 一种陀螺仪组合高阶误差系数分离与补偿方法和系统 | |
Mel'nik et al. | Determining gyroscopic integrator errors due to diffraction of sound waves | |
CN112578147B (zh) | 一种常值加速度引起的陀螺加速度计输出测定方法 | |
RU2382331C1 (ru) | Одноосный силовой гиростабилизатор | |
CN104697510B (zh) | 一种卫星单轴姿态角速率的高精度高带宽测量方法 | |
US7137208B2 (en) | Leveling device | |
Bogolyubov et al. | Astatic gyrocompass based on a hybrid micromechanical gyroscope |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |