CN111551164A - 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 - Google Patents
速率偏频激光陀螺寻北仪航向效应误差的补偿方法 Download PDFInfo
- Publication number
- CN111551164A CN111551164A CN202010460655.2A CN202010460655A CN111551164A CN 111551164 A CN111551164 A CN 111551164A CN 202010460655 A CN202010460655 A CN 202010460655A CN 111551164 A CN111551164 A CN 111551164A
- Authority
- CN
- China
- Prior art keywords
- north
- seeker
- angle
- north seeker
- error
- 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
- 238000000034 method Methods 0.000 title claims abstract description 39
- 230000000694 effects Effects 0.000 title claims abstract description 33
- 238000005259 measurement Methods 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 8
- 238000005096 rolling process Methods 0.000 claims description 2
- 230000007246 mechanism Effects 0.000 description 6
- 239000011159 matrix material Substances 0.000 description 5
- 230000009466 transformation Effects 0.000 description 4
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Power Engineering (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及一种速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其中,包括:步骤一寻北仪在倾斜角度下进行东向寻北;步骤二寻北仪在倾斜角度下进行西向寻北;步骤三求取寻北仪Z轴向等效陀螺常值漂移εz;步骤四进行Z轴等效陀螺常值漂移补偿;利用补偿后的角速度进行初始对准等相关解算,消除航向效应误差。本发明一种速率偏频激光陀螺寻北仪航向效应误差的补偿方法,可对寻北仪的标度因数不对称误差和陀螺常值漂移误差进行等效补偿,从而消除航向误差效应,提高寻北仪的寻北精度。
Description
技术领域
本发明涉及导航技术,特别涉及一种速率偏频激光陀螺寻北仪航向效应误差的补偿方法。
背景技术
陀螺寻北仪的寻北精度主要取决于陀螺仪的精度。具体来说,主要取决于陀螺仪的随机噪声大小,随机噪声大,则寻北精度差,随机噪声小,则寻北精度高。
速率偏频激光陀螺寻北仪,则是利用激光陀螺仪在速率偏频条件下,其随机噪声要明显小于抖动偏频条件下的特性,使激光陀螺仪在恒速偏频条件下进行寻北。
速率偏频激光陀螺寻北仪都安装有转位机构,转位机构可带动惯性测量单元绕寻北仪的某一个轴向旋转(一般为寻北仪的Z轴)。
为了更清晰的说明速率偏频激光陀螺仪的寻北流程,首先定义五个坐标系:(1)i系为惯性坐标系;(2)n系为导航坐标系,一般为当地的东北天坐标系;(3)b系为陀螺寻北仪坐标系;(4)r系为惯性台体坐标系;(5)s系为惯性测量单元坐标系。其中,当陀螺寻北仪处于水平条件下时,b系的X轴,Y轴处于水平状态,Z轴指向天向;r系的Z轴与b系Z轴重合,r系能由转位机构带动绕b系的Z轴自由转动,r系绕b系Z轴转动的角度可通过圆光栅编码器或旋转变压器等测角传感器测量出来;而s系与r系固联,且s系的三个坐标轴合成的矢量与r系的Z轴重合,且s系到r系的坐标转换矩阵为
一般来说,速率偏频激光陀螺寻北仪的寻北过程中,惯性测量单元绕b系的Z轴以恒定的角速率旋转(旋转角速率为30°/s~50°/s),且激光陀螺仪的机械抖动处于关闭状态以降低激光陀螺仪的随机噪声。
速率偏频激光陀螺寻北仪的寻北解算流程一般如下:
(4)再通过测角传感器测量出r系相对b系转动角度ψ,计算出b系到r系的坐标转换矩阵:
(5)计算出b系到n系的坐标转换矩阵,也即姿态矩阵
所谓航向效应误差,即寻北仪在处于不同航向时,输出的航向角与真实航向角存在偏差,且该偏差与寻北仪所处的航向有一定的关系,即在不同航向上,偏差大小不恒定。
一般来说,航向效应误差都是寻北仪在有倾角的条件下产生。这是因为激光陀螺仪的标度因数误差、安装误差等动态误差的存在,转位机构以较大角速度旋转会激励出Z轴向较大的角速度误差,在寻北仪水平条件下,该误差不会投影到东向,因此不会影响寻北结果,然而在有水平倾角的条件下,Z轴向的角速度误差会投影到东向,进而严重影响寻北精度。
因此,速率偏频激光陀螺寻北仪还会采用正反转的方式消除这些误差源。即首先转位机构带动惯性测量单元以恒定角速率正向转动,并计算出航向角之后转位机构带动惯性测量单元以相同的角速率反向转动,再计算出航向角最后将二者平均即可得到速率偏频陀螺寻北仪的真实北向值
尽管速率偏频激光陀螺寻北仪会以正反转的方式进行寻北,这样可消除大部分航向效应误差源,进而降低航向效应误差,提高寻北精度。但是,只通过正反转方式,仍然有一些航向效应误差源难以被消除,如激光陀螺标度因数不对称误差和陀螺寻北仪Z轴向等效陀螺常值漂移,而对于高精度的寻北要求,这些误差源则是必须要考虑消除的。
发明内容
本发明的目的在于提供一种速率偏频激光陀螺寻北仪航向效应误差的补偿方法,用于解决上述现有技术的问题。
本发明一种速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其中,包括:步骤一寻北仪在倾斜角度下进行东向寻北;安装固定好寻北仪后,调整转台使寻北仪指向东向,然后连续寻北至少a次,记录每次寻北求得的输出的三个姿态角,并进行平均,记平均后的俯仰角为横滚角为航向角为其中,航向角北偏东为正,范围为0°~360°,寻北仪指北时航向角为0°;步骤二寻北仪在倾斜角度下进行西向寻北;转台的天向轴转动180°,再连续寻北至少b次,记录每次寻北求得的输出的三个姿态角,并进行平均,记平均后的俯仰角为横滚角为航向角为步骤三求取寻北仪Z轴向等效陀螺常值漂移εz;步骤四进行Z轴等效陀螺常值漂移补偿;设惯性测量单元输出的角速度转换到r系上为则r系的Z轴进行等效陀螺常值漂移的补偿方法为:之后利用补偿后的角速度进行初始对准等相关解算,消除航向效应误差。
根据本发明的速率偏频激光陀螺寻北仪航向效应误差的补偿方法的一实施例,其中,步骤一中首先明确对转台的要求,转台角位置测量精度在3″以内,且转台调平精度在30″以内。
根据本发明的速率偏频激光陀螺寻北仪航向效应误差的补偿方法的一实施例,其中,步骤一中寻北仪固定在单轴转台上,则需要沿着寻北仪航向方向垫高,使其具有一定的俯仰角,俯仰角的大小视寻北仪工作的最大俯仰角而定,并调整寻北仪横滚角在1°以内,之后将寻北仪用压块等结构固定。
根据本发明的速率偏频激光陀螺寻北仪航向效应误差的补偿方法的一实施例,其中,步骤一中寻北仪固定在多轴转台,需要将寻北仪用压条或压块固定后,调整转台某一轴,使寻北仪具有和安装到单轴转台相同要求的俯仰角和横滚角。
根据本发明的速率偏频激光陀螺寻北仪航向效应误差的补偿方法的一实施例,其中,a=b。
根据本发明的速率偏频激光陀螺寻北仪航向效应误差的补偿方法的一实施例,其中,a和b大于等于10。
根据本发明的速率偏频激光陀螺寻北仪航向效应误差的补偿方法的一实施例,其中,步骤三寻北仪Z轴向等效陀螺常值漂移εz求取过程包括:
εz=εE/sin(θ);
其中,
ωN=ωiecosL;
ωie为地球自转角速率,L为当地的地理纬度,并且以上涉及到的角度运算单位都是弧度。
本发明一种速率偏频激光陀螺寻北仪航向效应误差的补偿方法,可对寻北仪的标度因数不对称误差和陀螺常值漂移误差进行等效补偿,从而消除航向误差效应,提高寻北仪的寻北精度。
附图说明
无
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合实施例,对本发明的具体实施方式作进一步详细描述。
对于速率偏频激光陀螺寻北仪通过正反向连续旋转方案消除大部分误差源后,余下的误差源主要为寻北仪Z轴向标度因数不对称误差和Z轴向等效陀螺常值漂移,因此,要对速率偏频激光陀螺寻北仪航向效应误差进行补偿,主要就是对这两项误差进行补偿,消除这两项误差对寻北结果的影响。
由于速率偏频激光陀螺仪在寻北过程中,寻北仪的转位机构以恒定的角速率带动惯性测量单元正反向转动,因此由标度因数不对称误差引起的Z轴向等效陀螺漂移也是恒定的,故可以将该项误差引起的角速度误差也等效成寻北仪Z轴向的陀螺常值漂移,一并进行补偿。
速率偏频激光陀螺寻北仪航向效应误差的补偿方法如下:
第一步寻北仪在倾斜角度下进行东向寻北
首先明确对转台的要求。该补偿方法需要高精度的角位置转台,可单轴也可多轴,转台角位置测量精度在3″以内,且转台调平精度在30″以内。
寻北仪固定在转台上时,如固定在单轴转台上,则需要沿着寻北仪航向方向垫高,使其具有一定的俯仰角,俯仰角的大小视寻北仪工作的最大俯仰角而定(如要求寻北仪在俯仰角5°以内使用,则调整寻北仪俯仰角为5°),并调整寻北仪横滚角在1°以内,之后将寻北仪用压块等结构固定。如采用多轴转台,则需要将寻北仪用压条或压块固定后,调整转台某一轴(一般为内环轴),使寻北仪具有和安装到单轴转台相同要求的俯仰角和横滚角。
安装固定好寻北仪后,调整转台使寻北仪指向东向(不必精确地指向东向,与东向相差5′以内即可),然后连续寻北至少10次,记录每次寻北求得的输出的三个姿态角,并进行平均,记平均后的俯仰角为横滚角为航向角为其中,航向角北偏东为正,范围为0°~360°,寻北仪指北时航向角为0°;
第二步 寻北仪在倾斜角度下进行西向寻北
第三步寻北仪Z轴向等效陀螺常值漂移求取
寻北仪Z轴向等效陀螺常值漂移εz求取过程如下:
εz=εE/sin(θ)
其中,
ωN=ωiecosL
ωie为地球自转角速率,L为当地的地理纬度,并且以上涉及到的角度运算单位都是弧度(rad)。
第四步Z轴等效陀螺常值漂移补偿
由于r系的Z轴与寻北仪的Z轴相重合,因此寻北仪Z轴的等效陀螺常值漂移即为r系的Z轴的等效陀螺常值漂移,并且寻北仪的初始对准解算是在r系上进行的,因此只需将Z轴等效陀螺常值漂移补偿到r系的Z轴上即可。
之后再利用补偿后的角速度进行初始对准等相关解算即可消除航向效应误差。
速率偏频激光陀螺寻北仪经过正反转连续旋转可消除大部分航向效应误差源,但仍有部分误差源影响寻北精度,这对于高精度寻北非常不利。本专利分析出残余的影响航向效应误差的两项误差源,即为陀螺标度因数不对称误差和Z轴等效陀螺常值漂移。并且利用速率偏频寻北过程中惯性测量单元匀速旋转的特性,将陀螺标度因数不对称误差引起的角速度误差也等效成Z轴向陀螺常值漂移,再通过在有倾角条件下的东向和西向两个位置的寻北,利用捷联惯导初始对准的等效东向陀螺漂移和寻北误差之间的关系,准确的将Z轴向陀螺常值漂移分离求取出来,并进行补偿。
本发明设计了一种速率偏频激光陀螺寻北仪航向效应误差补偿方法,该方法可以进一步消除影响航向效应误差的误差源:标度因数不对称误差和Z轴向等效陀螺常值漂移,从而进一步提高速率偏频激光陀螺寻北仪的寻北精度。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (7)
1.一种速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其特征在于,包括:
步骤一寻北仪在倾斜角度下进行东向寻北;
安装固定好寻北仪后,调整转台使寻北仪指向东向,然后连续寻北至少a次,记录每次寻北求得的输出的三个姿态角,并进行平均,记平均后的俯仰角为横滚角为航向角为其中,航向角北偏东为正,范围为0°~360°,寻北仪指北时航向角为0°;
步骤二寻北仪在倾斜角度下进行西向寻北;
步骤三求取寻北仪Z轴向等效陀螺常值漂移εz;
步骤四进行Z轴等效陀螺常值漂移补偿;
之后利用补偿后的角速度进行初始对准等相关解算,消除航向效应误差。
2.如权利要求1所述的速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其特征在于,步骤一中首先明确对转台的要求,转台角位置测量精度在3″以内,且转台调平精度在30″以内。
3.如权利要求1所述的速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其特征在于,步骤一中寻北仪固定在单轴转台上,则需要沿着寻北仪航向方向垫高,使其具有一定的俯仰角,俯仰角的大小视寻北仪工作的最大俯仰角而定,并调整寻北仪横滚角在1°以内,之后将寻北仪用压块等结构固定。
4.如权利要求1所述的速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其特征在于,步骤一中寻北仪固定在多轴转台,需要将寻北仪用压条或压块固定后,调整转台某一轴,使寻北仪具有和安装到单轴转台相同要求的俯仰角和横滚角。
5.如权利要求1所述的速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其特征在于,a=b。
6.如权利要求5所述的速率偏频激光陀螺寻北仪航向效应误差的补偿方法,其特征在于,a和b大于等于10。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010460655.2A CN111551164B (zh) | 2020-05-27 | 2020-05-27 | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010460655.2A CN111551164B (zh) | 2020-05-27 | 2020-05-27 | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111551164A true CN111551164A (zh) | 2020-08-18 |
CN111551164B CN111551164B (zh) | 2023-10-20 |
Family
ID=72008538
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010460655.2A Active CN111551164B (zh) | 2020-05-27 | 2020-05-27 | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111551164B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113175941A (zh) * | 2021-03-31 | 2021-07-27 | 西安理工大学 | 基于双轴转台的激光陀螺寻北仪参数辨识方法 |
CN114001754A (zh) * | 2021-10-29 | 2022-02-01 | 北京航天发射技术研究所 | 一种航向调整方法、航向调整装置、可读介质及寻北仪 |
CN114459465A (zh) * | 2021-03-02 | 2022-05-10 | 北京天兵科技有限公司 | 一种mems惯组方位的在线补偿方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2187074C1 (ru) * | 2001-04-16 | 2002-08-10 | Открытое акционерное общество Пермская научно-производственная приборостроительная компания | Способ коррекции гирокомпаса |
US20090119937A1 (en) * | 2007-11-13 | 2009-05-14 | Watson William S | Method and system for heading indication with drift compensation |
CN105659809B (zh) * | 2005-06-02 | 2010-05-05 | 北京航天时代光电科技有限公司 | 基于倾斜补偿和粗精组合位置法的光纤陀螺寻北仪及寻北方法 |
CN101738182A (zh) * | 2009-12-24 | 2010-06-16 | 陕西宝成航空仪表有限责任公司 | 双向恒速偏频激光陀螺寻北方法及双向恒速偏频激光陀螺寻北仪 |
CN103743413A (zh) * | 2013-12-27 | 2014-04-23 | 哈尔滨工程大学 | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 |
-
2020
- 2020-05-27 CN CN202010460655.2A patent/CN111551164B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2187074C1 (ru) * | 2001-04-16 | 2002-08-10 | Открытое акционерное общество Пермская научно-производственная приборостроительная компания | Способ коррекции гирокомпаса |
CN105659809B (zh) * | 2005-06-02 | 2010-05-05 | 北京航天时代光电科技有限公司 | 基于倾斜补偿和粗精组合位置法的光纤陀螺寻北仪及寻北方法 |
US20090119937A1 (en) * | 2007-11-13 | 2009-05-14 | Watson William S | Method and system for heading indication with drift compensation |
CN101738182A (zh) * | 2009-12-24 | 2010-06-16 | 陕西宝成航空仪表有限责任公司 | 双向恒速偏频激光陀螺寻北方法及双向恒速偏频激光陀螺寻北仪 |
CN103743413A (zh) * | 2013-12-27 | 2014-04-23 | 哈尔滨工程大学 | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 |
Non-Patent Citations (3)
Title |
---|
杨孟兴;徐兵华;: "激光陀螺捷联惯性导航***的误差参数标定" * |
陈璞,冯培德,王锦瑜: "速率偏频激光陀螺标定方法讨论" * |
高延滨;王庭军;李光春;: "光纤陀螺常值漂移误差自补偿方法" * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114459465A (zh) * | 2021-03-02 | 2022-05-10 | 北京天兵科技有限公司 | 一种mems惯组方位的在线补偿方法 |
CN114459465B (zh) * | 2021-03-02 | 2023-08-22 | 北京天兵科技有限公司 | 一种mems惯组方位的在线补偿方法 |
CN113175941A (zh) * | 2021-03-31 | 2021-07-27 | 西安理工大学 | 基于双轴转台的激光陀螺寻北仪参数辨识方法 |
CN113175941B (zh) * | 2021-03-31 | 2023-09-22 | 西安理工大学 | 基于双轴转台的激光陀螺寻北仪参数辨识方法 |
CN114001754A (zh) * | 2021-10-29 | 2022-02-01 | 北京航天发射技术研究所 | 一种航向调整方法、航向调整装置、可读介质及寻北仪 |
Also Published As
Publication number | Publication date |
---|---|
CN111551164B (zh) | 2023-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109211269B (zh) | 一种双轴旋转惯导***姿态角误差标定方法 | |
CN111551164A (zh) | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 | |
CN104501838B (zh) | 捷联惯导***初始对准方法 | |
CA1277401C (en) | Method for determining the heading of an aircraft | |
US3509765A (en) | Inertial navigation system | |
CN108731674B (zh) | 一种基于单轴旋转调制的惯性天文组合导航***及计算方法 | |
CN106441357B (zh) | 一种基于阻尼网络的单轴旋转sins轴向陀螺漂移校正方法 | |
CN106895853B (zh) | 一种电磁计程仪辅助船用陀螺罗经行进间对准方法 | |
CN109459008B (zh) | 一种小型中高精度光纤陀螺寻北装置及方法 | |
JP2007155584A (ja) | 慣性航法システム | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN105865490B (zh) | 一种惯性稳定平台固定基座多位置自瞄准方法 | |
CN103256943A (zh) | 一种在单轴旋转捷联惯导***中刻度因数误差的补偿方法 | |
CN103743413A (zh) | 倾斜状态下调制寻北仪安装误差在线估计与寻北误差补偿方法 | |
CN111366144B (zh) | 一种陀螺寻北仪多位置寻北方法 | |
CN113503892B (zh) | 一种基于里程计和回溯导航的惯导***动基座初始对准方法 | |
CN102052921A (zh) | 一种单轴旋转捷联惯导***初始航向的确定方法 | |
CN114061572A (zh) | 一种用于旋转式惯导***的双轴旋转调制方法 | |
CN110501028A (zh) | 一种用于双轴旋转mems-sins的十六位置旋转调制方法 | |
CN109470274B (zh) | 一种车载光电经纬仪载车平台变形测量***及方法 | |
CN105300407B (zh) | 一种用于单轴调制激光陀螺惯导***的海上动态启动方法 | |
CN114148536A (zh) | 一种用于光电吊舱的线位移补偿控制方法 | |
CN110488853B (zh) | 一种降低转轴涡动影响的混合式惯导***稳定控制指令的计算方法 | |
CN112798014A (zh) | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 | |
JP2001141507A (ja) | 慣性航法装置 |
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 |