CN103697878A - 一种单陀螺单加速度计旋转调制寻北方法 - Google Patents
一种单陀螺单加速度计旋转调制寻北方法 Download PDFInfo
- Publication number
- CN103697878A CN103697878A CN201310690243.8A CN201310690243A CN103697878A CN 103697878 A CN103697878 A CN 103697878A CN 201310690243 A CN201310690243 A CN 201310690243A CN 103697878 A CN103697878 A CN 103697878A
- Authority
- CN
- China
- Prior art keywords
- prime
- cos
- accelerometer
- angle
- gyroscope
- 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.)
- Granted
Links
Images
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
- G01C19/58—Turn-sensitive devices without moving masses
- G01C19/64—Gyrometers using the Sagnac effect, i.e. rotation-induced shifts between counter-rotating electromagnetic beams
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Power Engineering (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
本发明属于光学陀螺寻北技术领域,具体涉及一种单陀螺单加速度计旋转调制寻北方法。本方法以单轴光学陀螺和单轴加速度计为敏感器件,利用连续旋转的方法消除陀螺漂移等因素对寻北结果的影响,通过设定中间变量建立起陀螺仪输出的角速度及加速度计输出的加速度与初始纬度及航向角之间的关系,用单个加速度计的输出结果补偿初始滚动角及俯仰角的影响;并通过建立以中间变量、陀螺漂移和加速度计零偏为状态量的Kalman滤波误差模型,经滤波估计获得中间变量的数值;并通过数值计算获得初始纬度及航向角的数值。本方法利用单轴陀螺、单轴加速度计以及旋转机构即可完成寻北,不需要初始纬度信息、不需要精确调平,具有简单、实用、可靠性高、成本低等特点。
Description
技术领域
本发明属于光学陀螺寻北技术领域,具体涉及一种单陀螺单加速度计旋转调制寻北方法。
背景技术
寻北仪在陆军战车、火炮等军事领域得到广泛的应用。寻北仪的基本原理是在静态条件下,采用陀螺仪测量北向地球自转角速度,来获得陀螺敏感轴相对北向的偏角,即航向角。寻北原理决定了其精度容易受到陀螺零位、不水平角等因素的影响,需要采取一定措施来消除各种因素对寻北精度的影响。
通常采用的寻北方法是利用两个陀螺仪,配合旋转机构,在0°~360°范围内等间距位置采集陀螺测量输出的角速度值,来获得陀螺敏感轴相对北向的偏角,即航向角。常用的寻北方案包括两位置方案、三位置方案以及四位置方案等。近年来开始出现利用连续旋转调制的方法,来消除陀螺零位等因素的影响。文献《一种实用旋转调制式陀螺寻北仪的设计》(徐海刚等,兵工学报,第31卷第5期,2010年5月)以及《采用旋转调制技术的高精度陀螺寻北方案》(白云超等,中国惯性技术学报,第18卷第4期,2010年8月)都提出利用连续旋转调制的方案消除陀螺漂移等因素对寻北精度的影响,两篇文献的共同点都是采用单轴陀螺和两个加速度计并利用旋转机构的连续旋转来完成寻北计算。
发明内容
本发明需要解决的技术问题为:提出一种利用单轴光学陀螺、单轴加速度计以及连续旋转调制技术即可实现寻北的方法。
本发明的技术方案如下所述:
一种单陀螺单加速度计旋转调制寻北方法,包括以下步骤:
步骤1.滤波估计
步骤1.1.误差模型
通过对旋转调制下陀螺仪及加速度计输出进行公式推导得如下输出数据关系:
其中,
A′、B′、C′及D′为中间变量;
ε′为陀螺漂移;
α为转台旋转角速度,范围可以为5°/s~40°/s;
为陀螺仪输出的角速度信息;
利用上述误差方程,建立Kalman滤波器,取状态量如下:
得观测方程:
对上式在滤波周期内进行积分,得新的观测方程:
其中,
观测量为:
步骤1.2.Kalman滤波方程
建立上述误差模型后,利用Kalman滤波方法作为参数辨识方法,完成对状态量的估计:
状态一步预测:
状态估计:
滤波增益矩阵:
一步预测误差方差阵:
估计误差方差阵:
Pk=[I-KkHk]Pk,k-1 (10)
其中,
Φk,k-1为状态一步转移矩阵;
Hk为量测矩阵;
Zk为量测量;
Kk为滤波增益矩阵;
Rk为观测噪声阵;
Pk,k-1为一步预测误差方差阵;
Pk为估计误差方差阵;
Γk,k-1为系统噪声驱动阵;
Qk-1为系统噪声阵;
步骤2.寻北计算
由步骤1的Kalman滤波得到中间变量A′、B′、C′、D′的数值,由安装误差角经下式计算获得新的中间变量A、B、C、D:
其中,
θ1为陀螺仪敏感轴与转台平面的夹角;
θ2为加速度计敏感轴与转台平面的夹角;
则初始姿态角由下式计算获得:
其中,
φ为陀螺仪敏感轴与加速度计敏感轴在转台平面投影的夹角;
θ为初始俯仰角;
γ为初始滚动角;
通过下式计算纬度和初始航向角:
其中,
其中,
ωie为地球自转角速率;
L为寻北计算获得的纬度信息;
ψ为寻北计算获得的初始航向角信息。
本发明的有益效果为:
本发明的一种单陀螺单加速度计旋转调制寻北方法,利用单轴陀螺、单轴加速度计以及旋转机构即可完成寻北。
本发明的方法通过旋转机构的连续旋转补偿陀螺漂移等因素对寻北计算的影响,通过加速度计输出补偿不水平角的影响,并建立中间变量与纬度及初始航向角之间的关系,通过Kalman滤波估计中间变量的数值,完成寻北计算。
本发明的方法不需输入初始纬度信息,不需对台面进行精确调平,具有简单、实用、可靠性高以及成本低的特点,可满足不同精度寻北仪的需求。
附图说明
图1为实现本发明方法的陀螺仪及加速度计与转台平面的安装关系示意图。
具体实施方式
下面结合附图和实施例对本发明的一种单陀螺单加速度计旋转调制寻北方法进行详细说明。
本发明的方法利用旋转调制技术消除陀螺漂移等因素对寻北精度的影响,通过加速度计零偏计算并补偿不水平角对寻北结果的影响。本寻北方法主要分两个步骤:一是滤波估计,主要是通过Kalman滤波完成中间变量的估计;二是寻北计算,即利用滤波估计出的中间变量的数值,经过公式计算获得寻北结果。
步骤1.滤波估计
滤波估计主要是建立中间变量的误差模型,利用Kalman滤波方法完成中间变量的数值估计。
步骤1.1.误差模型
通过对旋转调制下陀螺仪及加速度计输出进行公式推导可得输出数据关系如下:
其中,
A′、B′、C′及D′为中间变量,没有特定物理意义,均为定值;
ε′为陀螺漂移;
α为转台旋转角速度,该值的选取与所用的陀螺仪精度相关,稳定性差的陀螺α的取值应稍大,范围通常在5°/s~40°/s;
利用上述误差方程,建立Kalman滤波器,取状态量如下:
可得观测方程:
为了消除角速率及加速度噪声对滤波器的影响,对上式在滤波周期内进行积分,可得新的观测方程为:
观测量为:
步骤1.2.Kalman滤波方程
建立上述误差模型后,利用Kalman滤波方法作为参数辨识方法,完成对状态量的估计。Kalman滤波方程采用文献《卡尔曼滤波和组合导航原理》(第一版,秦永元等编著)中的形式,具体公式如下:
状态一步预测:
状态估计:
滤波增益矩阵:
一步预测误差方差阵:
估计误差方差阵:
Pk=[I-KkHk]Pk,k-1 (22)
其中,
Φk,k-1为状态一步转移矩阵;
Hk为量测矩阵;
Zk为量测量;
Kk为滤波增益矩阵;
Rk为观测噪声阵;
Pk,k-1为一步预测误差方差阵;
Pk为估计误差方差阵;
Γk,k-1为系统噪声驱动阵;
Qk-1为系统噪声阵。
步骤2.寻北计算
由步骤1的Kalman滤波可得中间变量A′、B′、C′、D′的数值,接下来即可进行寻北结果的计算。
设θ1,θ2及φ为陀螺仪和加速度计敏感轴与转台平面之间的安装误差角,可由标定获得,安装误差角的定义如图1所示:θ1为陀螺仪敏感轴与转台平面的夹角,θ2为加速度计敏感轴与转台平面的夹角,φ为陀螺仪敏感轴与加速度计敏感轴在转台平面投影的夹角。
由安装误差角经下式计算获得新的中间变量A、B、C、D。
则初始姿态角可由下式计算获得:
其中θ为初始俯仰角,γ为初始滚动角。
按如下方法计算如下变量:
其中,
a、b、d、e、f以及m、n、l都为中间变量,没有特定物理意义,均为定值;
ωie为地球自转角速率。
由上述中间变量作如下计算:
其中L及ψ即为寻北计算获得的纬度及初始航向角信息。
本发明的关键是通过设定中间变量建立起陀螺仪输出的角速度及加速度计输出的加速度与初始纬度及航向角之间的关系,利用旋转过程中俯仰角和滚动角存在相关转换的特点,用单个加速度计的输出结果补偿初始滚动角及俯仰角的影响,并通过建立以中间变量、陀螺漂移和加速度计零偏为状态量的Kalman滤波误差模型,经过滤波估计获得中间变量的数值,并通过数值计算获得初始纬度及航向角的数值,实现单轴陀螺仪及单轴加速度计连续旋转的寻北计算。本方法在实施时首先建立Kalman滤波器的误差模型,通过滤波计算完成对中间变量的估计,并在得到估计值后,利用公式计算获得初始纬度及航向角的数值。
Claims (2)
1.一种单陀螺单加速度计旋转调制寻北方法,其特征在于:包括以下步骤:
步骤1.滤波估计
步骤1.1.误差模型
通过对旋转调制下陀螺仪及加速度计输出进行公式推导得如下输出数据关系:
其中,
A′、B′、C′及D′为中间变量;
ε′为陀螺漂移;
α为转台旋转角速度;
为陀螺仪输出的角速度信息;
加速度计输出的加速度计信息;
利用上述误差方程,建立Kalman滤波器,取状态量如下:
状态方程由各状态量的定义得Φ=0;
得观测方程:
对上式在滤波周期内进行积分,得新的观测方程:
观测量为:
步骤1.2.Kalman滤波方程
建立上述误差模型后,利用Kalman滤波方法作为参数辨识方法,完成对状态量的估计:
状态一步预测:
状态估计:
滤波增益矩阵:
一步预测误差方差阵:
估计误差方差阵:
Pk=[I-KkHk]Pk,k-1 (10)
其中,
为状态估计矩阵;
Φk,k-1为状态一步转移矩阵;
Hk为量测矩阵;
Zk为量测量;
Kk为滤波增益矩阵;
Rk为观测噪声阵;
Pk,k-1为一步预测误差方差阵;
Pk为估计误差方差阵;
Γk,k-1为系统噪声驱动阵;
Qk-1为系统噪声阵;
步骤2.寻北计算
由步骤1的Kalman滤波得到中间变量A′、B′、C′、D′的数值,由安装误差角经下式计算获得新的中间变量A、B、C、D:
其中,
θ1为陀螺仪敏感轴与转台平面的夹角;
θ2为加速度计敏感轴与转台平面的夹角;
则初始姿态角由下式计算获得:
其中,
φ为陀螺仪敏感轴与加速度计敏感轴在转台平面投影的夹角;
θ为初始俯仰角;
γ为初始滚动角;
通过下式计算纬度和初始航向角:
其中,
其中,
ωie为地球自转角速率;
L为寻北计算获得的纬度信息;
ψ为寻北计算获得的初始航向角信息。
2.根据权利要求1所述的一种单陀螺单加速度计旋转调制寻北方法,其特征在于:步骤1.1中,所述转台旋转角速度α范围为5°/s~40°/s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310690243.8A CN103697878B (zh) | 2013-12-16 | 2013-12-16 | 一种单陀螺单加速度计旋转调制寻北方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310690243.8A CN103697878B (zh) | 2013-12-16 | 2013-12-16 | 一种单陀螺单加速度计旋转调制寻北方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103697878A true CN103697878A (zh) | 2014-04-02 |
CN103697878B CN103697878B (zh) | 2017-06-13 |
Family
ID=50359490
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310690243.8A Active CN103697878B (zh) | 2013-12-16 | 2013-12-16 | 一种单陀螺单加速度计旋转调制寻北方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103697878B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105509768A (zh) * | 2015-11-27 | 2016-04-20 | 北京航天控制仪器研究所 | 一种单轴寻北仪的误差标定方法 |
CN105628025A (zh) * | 2015-12-31 | 2016-06-01 | 中国人民解放军国防科学技术大学 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
CN109084761A (zh) * | 2018-08-07 | 2018-12-25 | 合肥正阳光电科技有限责任公司 | 一种基于惯性寻北装置的抗冲击寻北解算方法 |
CN109903545A (zh) * | 2019-03-27 | 2019-06-18 | 湖北医药学院 | 一种车联网数据传输的方法及系统 |
CN110926447A (zh) * | 2019-12-16 | 2020-03-27 | 重庆华渝电气集团有限公司 | 一种具有自主导航功能的单轴光纤陀螺寻北方法及航姿导航方法 |
CN112414432A (zh) * | 2020-11-26 | 2021-02-26 | 蓝箭航天空间科技股份有限公司 | 航天运载器用惯组与转台安装误差标定方法及服务器 |
CN114111748A (zh) * | 2021-11-29 | 2022-03-01 | 重庆华渝电气集团有限公司 | 一种微型动力调谐陀螺仪的安装误差角调整结构 |
WO2022174831A1 (zh) * | 2021-02-20 | 2022-08-25 | 广州导远电子科技有限公司 | 一种连续寻北装置、方法、电子设备及存储介质 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102840856A (zh) * | 2011-06-24 | 2012-12-26 | 西安测绘研究所 | 一种动态旋转调制的陀螺仪寻北方法 |
-
2013
- 2013-12-16 CN CN201310690243.8A patent/CN103697878B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102840856A (zh) * | 2011-06-24 | 2012-12-26 | 西安测绘研究所 | 一种动态旋转调制的陀螺仪寻北方法 |
Non-Patent Citations (2)
Title |
---|
徐建华等: "旋转调制式寻北仪滤波技术研究", 《北京理工大学学报》 * |
王海明等: "一种纬度未知的全姿态光纤陀螺寻北方法", 《中国惯性技术学报》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105509768B (zh) * | 2015-11-27 | 2018-05-22 | 北京航天控制仪器研究所 | 一种单轴寻北仪的误差标定方法 |
CN105509768A (zh) * | 2015-11-27 | 2016-04-20 | 北京航天控制仪器研究所 | 一种单轴寻北仪的误差标定方法 |
CN105628025A (zh) * | 2015-12-31 | 2016-06-01 | 中国人民解放军国防科学技术大学 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
CN105628025B (zh) * | 2015-12-31 | 2018-06-29 | 中国人民解放军国防科学技术大学 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
CN109084761B (zh) * | 2018-08-07 | 2021-09-10 | 合肥正阳光电科技有限责任公司 | 一种基于惯性寻北装置的抗冲击寻北解算方法 |
CN109084761A (zh) * | 2018-08-07 | 2018-12-25 | 合肥正阳光电科技有限责任公司 | 一种基于惯性寻北装置的抗冲击寻北解算方法 |
CN109903545A (zh) * | 2019-03-27 | 2019-06-18 | 湖北医药学院 | 一种车联网数据传输的方法及系统 |
CN110926447A (zh) * | 2019-12-16 | 2020-03-27 | 重庆华渝电气集团有限公司 | 一种具有自主导航功能的单轴光纤陀螺寻北方法及航姿导航方法 |
CN110926447B (zh) * | 2019-12-16 | 2022-02-22 | 重庆华渝电气集团有限公司 | 一种具有自主导航功能的单轴光纤陀螺寻北方法及航姿导航方法 |
CN112414432A (zh) * | 2020-11-26 | 2021-02-26 | 蓝箭航天空间科技股份有限公司 | 航天运载器用惯组与转台安装误差标定方法及服务器 |
WO2022174831A1 (zh) * | 2021-02-20 | 2022-08-25 | 广州导远电子科技有限公司 | 一种连续寻北装置、方法、电子设备及存储介质 |
CN114111748A (zh) * | 2021-11-29 | 2022-03-01 | 重庆华渝电气集团有限公司 | 一种微型动力调谐陀螺仪的安装误差角调整结构 |
CN114111748B (zh) * | 2021-11-29 | 2023-08-15 | 重庆华渝电气集团有限公司 | 一种微型动力调谐陀螺仪的安装误差角调整结构 |
Also Published As
Publication number | Publication date |
---|---|
CN103697878B (zh) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103697878A (zh) | 一种单陀螺单加速度计旋转调制寻北方法 | |
CN101514900B (zh) | 一种单轴旋转的捷联惯导系统初始对准方法 | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
CN105698822B (zh) | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 | |
CN102706366B (zh) | 一种基于地球自转角速率约束的sins初始对准方法 | |
CN102589546B (zh) | 一种抑制器件斜坡误差影响的光纤捷联惯组往复式两位置寻北方法 | |
CN109974697A (zh) | 一种基于惯性系统的高精度测绘方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN103900565A (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
CN101793523A (zh) | 一种组合导航和光电探测一体化系统 | |
CN105021192A (zh) | 一种基于零速校正的组合导航系统的实现方法 | |
CN103256943A (zh) | 一种在单轴旋转捷联惯导系统中刻度因数误差的补偿方法 | |
CN102679978B (zh) | 一种旋转式捷联惯性导航系统静基座初始对准方法 | |
CN111102993A (zh) | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN201159646Y (zh) | 捷联式多位置陀螺罗盘 | |
CN102680000A (zh) | 应用零速/航向修正的光纤捷联惯组在线标定方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN103217174B (zh) | 一种基于低精度微机电系统的捷联惯导系统初始对准方法 | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN104864874B (zh) | 一种低成本单陀螺航位推算导航方法及系统 | |
CN102798399A (zh) | 基于双轴转动方案的捷联惯导系统误差抑制方法 | |
CN103674064B (zh) | 捷联惯性导航系统的初始标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |