CN106595623A - 一种基于多传感器数据融合的滚转角速率高精度测量方法 - Google Patents
一种基于多传感器数据融合的滚转角速率高精度测量方法 Download PDFInfo
- Publication number
- CN106595623A CN106595623A CN201611179422.5A CN201611179422A CN106595623A CN 106595623 A CN106595623 A CN 106595623A CN 201611179422 A CN201611179422 A CN 201611179422A CN 106595623 A CN106595623 A CN 106595623A
- Authority
- CN
- China
- Prior art keywords
- rolling angular
- gyroscope
- range
- inner core
- data
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
Abstract
本发明涉及旋转弹的滚转角速率测量技术,具体是一种基于多传感器数据融合的滚转角速率高精度测量方法。本发明解决了主动半捷联惯性测量系统在测量旋转弹的滚转角速率时测量精度低的问题。一种基于多传感器数据融合的滚转角速率高精度测量方法,该方法是采用如下步骤实现的:步骤S1:定义载体坐标系;步骤S2:在主动半捷联惯性测量系统的外筒中安装大量程陀螺仪;在主动半捷联惯性测量系统的MIMU顶部安装中量程陀螺仪;在主动半捷联惯性测量系统的MIMU中安装小量程陀螺仪;步骤S3:计算出外筒和内筒之间的相对转速数据;步骤S4:复现出弹体滚转角速率数据;步骤S5:将复现出的弹体滚转角速率数据作为控制信号。本发明适用于旋转弹的滚转角速率测量。
Description
技术领域
本发明涉及旋转弹的滚转角速率测量技术,具体是一种基于多传感器数据融合的滚转角速率高精度测量方法。
背景技术
旋转弹的滚转角速率测量是其制导化与精确打击的核心关键技术。目前,旋转弹的滚转角速率测量普遍是利用主动半捷联惯性测量系统(参见中国专利ZL201110025530.8)来实现的,该系统运行时,外筒中的大量程陀螺仪输出弹体滚转角速率数据,该数据作为控制信号控制电机带动内筒进行反转,其目的是使得内筒与惯性坐标系之间尽可能保持相对静止(即内筒滚转角速率尽可能小),由此使得系统的测量精度尽可能高。然而实践表明,在利用主动半捷联惯性测量系统测量旋转弹的滚转角速率时,存在如下问题:由于外筒中的大量程陀螺仪的测量精度低,导致其输出的弹体滚转角速率数据精度低(即控制信号的精度低),由此导致内筒会在控制信号噪声的驱动下及电机本身精度的影响下进行角速率为100°/s左右的微幅振荡,从而导致内筒与惯性坐标系之间难以保持相对静止,同时内筒这种微幅振荡会促进导航解算时参数发散,降低解算精度,进而导致系统的测量精度降低。基于此,有必要发明一种能够减小内筒滚转角速率的方法,以解决主动半捷联惯性测量系统在测量旋转弹的滚转角速率时测量精度低的问题。
发明内容
本发明为了解决主动半捷联惯性测量系统在测量旋转弹的滚转角速率时测量精度低的问题,提供了一种基于多传感器数据融合的滚转角速率高精度测量方法。
本发明是采用如下技术方案实现的:
一种基于多传感器数据融合的滚转角速率高精度测量方法,该方法是采用如下步骤实现的:
步骤S1:定义载体坐标系:设弹体处于水平飞行的状态下,弹体重心作为载体坐标系的原点,弹体飞行方向作为载体坐标系的Xb轴方向,沿弹体所在地垂线向上作为载体坐标系的Yb轴方向,根据右手直角坐标系确定载体坐标系的Zb轴方向;
步骤S2:在主动半捷联惯性测量系统的外筒中安装大量程陀螺仪;在主动半捷联惯性测量系统的MIMU顶部安装中量程陀螺仪;在主动半捷联惯性测量系统的MIMU中安装小量程陀螺仪;在主动半捷联惯性测量系统的内筒中安装光电编码器;
步骤S3:当弹体发射后,利用硬件电路分别采集大量程陀螺仪输出的弹体滚转角速率数据、中量程陀螺仪输出的弹体滚转角速率数据、小量程陀螺仪输出的弹体滚转角速率数据、光电编码器输出的外筒和内筒之间的相对转角数据;然后对相对转角数据进行微分,由此计算出外筒和内筒之间的相对转速数据;
步骤S4:利用加权最小二乘法,对大量程陀螺仪输出的弹体滚转角速率数据、中量程陀螺仪输出的弹体滚转角速率数据、小量程陀螺仪输出的弹体滚转角速率数据、外筒和内筒之间的相对转速数据进行融合,由此精确复现出弹体滚转角速率数据;
步骤S5:将复现出的弹体滚转角速率数据作为控制信号,控制电机带动内筒进行反转,由此使得内筒与惯性坐标系之间保持相对静止。
本发明所述的一种基于多传感器数据融合的滚转角速率高精度测量方法不再将外筒中的大量程陀螺仪输出的弹体滚转角速率数据作为控制信号,而是通过对三个不同量程的陀螺仪同时输出的弹体滚转角速率数据以及外筒和内筒之间的相对转速数据进行融合,并将融合得到的弹体滚转角速率数据作为控制信号,由此使得内筒与惯性坐标系之间保持相对静止,从而有效提高了系统的测量精度。
本发明有效解决了主动半捷联惯性测量系统在测量旋转弹的滚转角速率时测量精度低的问题,适用于旋转弹的滚转角速率测量。
附图说明
图1是本发明步骤S1的示意图。
图2是本发明步骤S2的示意图。
具体实施方式
一种基于多传感器数据融合的滚转角速率高精度测量方法,该方法是采用如下步骤实现的:
步骤S1:定义载体坐标系:设弹体处于水平飞行的状态下,弹体重心作为载体坐标系的原点,弹体飞行方向作为载体坐标系的Xb轴方向,沿弹体所在地垂线向上作为载体坐标系的Yb轴方向,根据右手直角坐标系确定载体坐标系的Zb轴方向;
步骤S2:在主动半捷联惯性测量系统的外筒中安装大量程陀螺仪;在主动半捷联惯性测量系统的MIMU顶部安装中量程陀螺仪;在主动半捷联惯性测量系统的MIMU中安装小量程陀螺仪;在主动半捷联惯性测量系统的内筒中安装光电编码器;
步骤S3:当弹体发射后,利用硬件电路分别采集大量程陀螺仪输出的弹体滚转角速率数据、中量程陀螺仪输出的弹体滚转角速率数据、小量程陀螺仪输出的弹体滚转角速率数据、光电编码器输出的外筒和内筒之间的相对转角数据;然后对相对转角数据进行微分,由此计算出外筒和内筒之间的相对转速数据;
步骤S4:利用加权最小二乘法,对大量程陀螺仪输出的弹体滚转角速率数据、中量程陀螺仪输出的弹体滚转角速率数据、小量程陀螺仪输出的弹体滚转角速率数据、外筒和内筒之间的相对转速数据进行融合,由此精确复现出弹体滚转角速率数据;
步骤S5:将复现出的弹体滚转角速率数据作为控制信号,控制电机带动内筒进行反转,由此使得内筒与惯性坐标系之间保持相对静止。
所述步骤S2-S4中,大量程陀螺仪的量程为7200°/s,中量程陀螺仪的量程为900°/s,小量程陀螺仪的量程为400°/s。
Claims (2)
1.一种基于多传感器数据融合的滚转角速率高精度测量方法,其特征在于:该方法是采用如下步骤实现的:
步骤S1:定义载体坐标系:设弹体处于水平飞行的状态下,弹体重心作为载体坐标系的原点,弹体飞行方向作为载体坐标系的Xb轴方向,沿弹体所在地垂线向上作为载体坐标系的Yb轴方向,根据右手直角坐标系确定载体坐标系的Zb轴方向;
步骤S2:在主动半捷联惯性测量系统的外筒中安装大量程陀螺仪;在主动半捷联惯性测量系统的MIMU顶部安装中量程陀螺仪;在主动半捷联惯性测量系统的MIMU中安装小量程陀螺仪;在主动半捷联惯性测量系统的内筒中安装光电编码器;
步骤S3:当弹体发射后,利用硬件电路分别采集大量程陀螺仪输出的弹体滚转角速率数据、中量程陀螺仪输出的弹体滚转角速率数据、小量程陀螺仪输出的弹体滚转角速率数据、光电编码器输出的外筒和内筒之间的相对转角数据;然后对相对转角数据进行微分,由此计算出外筒和内筒之间的相对转速数据;
步骤S4:利用加权最小二乘法,对大量程陀螺仪输出的弹体滚转角速率数据、中量程陀螺仪输出的弹体滚转角速率数据、小量程陀螺仪输出的弹体滚转角速率数据、外筒和内筒之间的相对转速数据进行融合,由此精确复现出弹体滚转角速率数据;
步骤S5:将复现出的弹体滚转角速率数据作为控制信号,控制电机带动内筒进行反转,由此使得内筒与惯性坐标系之间保持相对静止。
2.根据权利要求1所述的一种基于多传感器数据融合的滚转角速率高精度测量方法,其特征在于:所述步骤S2-S4中,大量程陀螺仪的量程为7200°/s,中量程陀螺仪的量程为900°/s,小量程陀螺仪的量程为400°/s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611179422.5A CN106595623A (zh) | 2016-12-19 | 2016-12-19 | 一种基于多传感器数据融合的滚转角速率高精度测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611179422.5A CN106595623A (zh) | 2016-12-19 | 2016-12-19 | 一种基于多传感器数据融合的滚转角速率高精度测量方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106595623A true CN106595623A (zh) | 2017-04-26 |
Family
ID=58599686
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611179422.5A Pending CN106595623A (zh) | 2016-12-19 | 2016-12-19 | 一种基于多传感器数据融合的滚转角速率高精度测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106595623A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108007458A (zh) * | 2017-12-28 | 2018-05-08 | 苗正 | 一种捷联惯性原件连接装置及其用于测量机械臂角度方法 |
CN109459004A (zh) * | 2018-12-11 | 2019-03-12 | 湖南云中赛博信息科技有限公司 | 一种可扩展陀螺仪测量范围的测量系统及方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102155886A (zh) * | 2011-01-24 | 2011-08-17 | 中北大学 | 一种适用于高旋弹药的主动式半捷联惯性测量装置 |
CN102608912A (zh) * | 2012-03-23 | 2012-07-25 | 中北大学 | 主动式半捷联惯性测量装置驱动系统的精确控制方法 |
CN103822632A (zh) * | 2014-03-03 | 2014-05-28 | 山西科泰微技术有限公司 | 一种具有滚转隔离功能的惯性导航系统及其滚转隔离方法 |
US20140306055A1 (en) * | 2011-09-20 | 2014-10-16 | Bae Systems Bofors Ab | Method and gnc system for determination of roll angle |
-
2016
- 2016-12-19 CN CN201611179422.5A patent/CN106595623A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102155886A (zh) * | 2011-01-24 | 2011-08-17 | 中北大学 | 一种适用于高旋弹药的主动式半捷联惯性测量装置 |
US20140306055A1 (en) * | 2011-09-20 | 2014-10-16 | Bae Systems Bofors Ab | Method and gnc system for determination of roll angle |
CN102608912A (zh) * | 2012-03-23 | 2012-07-25 | 中北大学 | 主动式半捷联惯性测量装置驱动系统的精确控制方法 |
CN103822632A (zh) * | 2014-03-03 | 2014-05-28 | 山西科泰微技术有限公司 | 一种具有滚转隔离功能的惯性导航系统及其滚转隔离方法 |
Non-Patent Citations (7)
Title |
---|
LI JIE 等,: ""Error Compensation Technology of Semi-Strapdown MEMS Inertial Measurement System"", 《KEY ENGINEERING MATERIALS》 * |
刘秀锋 等,: ""半捷联惯性测量系统多路采集数据对齐方法"", 《传感技术学报》 * |
刘秀锋 等,: ""高旋弹用惯性测量系统多量程传感器组合设计"", 《传感器与微系统》 * |
李文豪 等,: ""基于加权最小二乘法的弹体转速测量方法研究"", 《中国测试》 * |
李杰 等,: ""高旋弹药飞行姿态测量用半捷联MEMS惯性测量装置研究"", 《兵工学报》 * |
段晓敏 等,: ""制导炮弹用半捷联式惯性导航系统平台设计与试验"", 《导弹与航天运载技术》 * |
王丽平 等,: ""弹载滚转稳定平台相对转角测量电路设计"", 《电子器件》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108007458A (zh) * | 2017-12-28 | 2018-05-08 | 苗正 | 一种捷联惯性原件连接装置及其用于测量机械臂角度方法 |
CN109459004A (zh) * | 2018-12-11 | 2019-03-12 | 湖南云中赛博信息科技有限公司 | 一种可扩展陀螺仪测量范围的测量系统及方法 |
CN109459004B (zh) * | 2018-12-11 | 2022-07-26 | 湖南云中赛博信息科技有限公司 | 一种可扩展陀螺仪测量范围的测量系统及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104406585B (zh) | 基于惯性检测的激光跟踪仪靶球定位系统 | |
EP2914966B1 (en) | A method for aligning a mobile device surface with the coordinate system of a sensor | |
CN110873575B (zh) | 一种基于惯性传感器的里程测量方法 | |
CN104697553B (zh) | 光纤陀螺捷联惯导系统加速度计内杆臂标定方法 | |
CN103471590A (zh) | 一种运动惯性追踪系统 | |
CN110068336A (zh) | 一种基于磁悬浮控制敏感陀螺平行构型的角运动测量方法 | |
CN116499497B (zh) | 基于模态反转的半球谐振陀螺惯导系统误差自校准方法 | |
CN107063299B (zh) | 一种用于数据复现的惯性/卫星组合导航演示验证系统 | |
CN106595623A (zh) | 一种基于多传感器数据融合的滚转角速率高精度测量方法 | |
CN103900614A (zh) | 一种九加速度计无陀螺惯导系统的重力补偿方法 | |
CN101581221B (zh) | 随钻测量系统 | |
CN109631952B (zh) | 航天器用光学陀螺组件姿态基准镜安装误差标定方法 | |
CN103869097B (zh) | 旋转弹航向角、俯仰角角速率测量方法 | |
CN104453856A (zh) | 单轴光纤陀螺在油井测斜中的三位置补偿算法 | |
CN109681189A (zh) | 一种井径扇区固井质量及轨迹一体化测量仪 | |
CN103557869A (zh) | 一种车载导航仪 | |
CN205539051U (zh) | 一种石英挠性伺服加速度计 | |
JP2019023619A (ja) | 位置エンコーダサンプリングタイミングシステム | |
CN105044757A (zh) | 卫星信号遮蔽区域gnss差分与惯性测量组合测图方法 | |
CN204329960U (zh) | 基于重锤的倾角动态测量装置 | |
CN113065572B (zh) | 多传感器融合的数据处理方法、定位装置及虚拟现实设备 | |
CN113701752A (zh) | 一种旋转弹用全捷联姿态测量装置及方法 | |
CN110712533B (zh) | 一种电动车辆及适用于电动车辆的运动状态判定方法 | |
CN102182449B (zh) | 采用固态振动角速率传感器组实现井下寻北的测量装置 | |
CN102539810A (zh) | 用于驱动多轴角速度传感器的设备 |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170426 |