CN102305635A - 一种光纤捷联罗经系统的对准方法 - Google Patents
一种光纤捷联罗经系统的对准方法 Download PDFInfo
- Publication number
- CN102305635A CN102305635A CN201110225420A CN201110225420A CN102305635A CN 102305635 A CN102305635 A CN 102305635A CN 201110225420 A CN201110225420 A CN 201110225420A CN 201110225420 A CN201110225420 A CN 201110225420A CN 102305635 A CN102305635 A CN 102305635A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- tau
- alignment
- omega
- carrier
- 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 27
- 239000013307 optical fiber Substances 0.000 title claims abstract description 21
- 239000011159 matrix material Substances 0.000 claims abstract description 50
- 238000001914 filtration Methods 0.000 claims abstract description 22
- 230000005484 gravity Effects 0.000 claims abstract description 17
- 238000005259 measurement Methods 0.000 claims abstract description 16
- 230000001133 acceleration Effects 0.000 claims abstract description 11
- 239000010453 quartz Substances 0.000 claims abstract description 3
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N silicon dioxide Inorganic materials O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 claims abstract description 3
- 238000012546 transfer Methods 0.000 claims description 12
- 239000000835 fiber Substances 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000007711 solidification Methods 0.000 claims description 4
- 230000008023 solidification Effects 0.000 claims description 4
- 238000012937 correction Methods 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000004458 analytical method Methods 0.000 abstract description 3
- 230000004927 fusion Effects 0.000 abstract description 2
- 230000000452 restraining effect Effects 0.000 abstract 1
- 238000012360 testing method Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000015271 coagulation Effects 0.000 description 1
- 238000005345 coagulation Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000006185 dispersion Substances 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Landscapes
- Gyroscopes (AREA)
Abstract
本发明提供的是一种光纤捷联罗经系统的对准方法。步骤包括:根据基于双积分重力矢量的并行解析粗对准算法,利用光纤捷联罗经系统采集的光纤陀螺和石英加速度计数据,以及地球自转角速率、重力加速度、纬度等信息,完成光纤捷联罗经系统的粗对准;根据基于比力的精对准方法,建立以失准角为系统状态,以比力信息为系统量测的光纤捷联罗经系统精对准的卡尔曼滤波模型;利用滤波估计的失准角信息闭环修正姿态矩阵,完成光纤捷联罗经系统的精对准。本发明的方法具有如下优点:(1)粗对准算法通过重力矢量的双积分运算和并行融合运算,对系统随机误差进行了平滑抑制,提高了粗对准的精度和可靠性,(2)精对准算法的滤波模型简单。
Description
技术领域
本发明涉及一种对载体航向和姿态的测量技术,尤其涉及一种光纤捷联罗经系统的自主对准方法。
背景技术
随着光纤陀螺技术的迅速发展,光纤捷联罗经已经成为国内外的研究热点。与传统陀螺罗经相比,光纤捷联罗经具有全固态、体积小、启动快、可靠性高等优点。LITEF公司的LFK-95型光纤捷联罗经的对准时间30min,航向精度为0.7°secL,水平精度为0.5°,法国IXSEA公司的OCTANS光纤捷联罗经能够在5min内完成对准,航向精度达到0.1°secL,水平精度优于0.01°(RMS)。目前,快速精确的自主对准技术是光纤捷联罗经系统的一项关键技术。
初始对准一般分为粗对准和精对准两个过程,粗对准要求在很短时间内将姿态误差降低到几度之内,精对准在粗对准基础上实现精确对准。由于载体工作环境如基座持续摇摆、风浪干扰、机械振动等影响,传统解析对准算法往往难以满足实际应用需求。因此,研究晃动基座下自主对准具有重要意义和应用需求。
目前也有部分与本发明有关的研究报告,例如:1、舰载机捷联惯导自对准方案设计与仿真,中国惯性技术学报,2008,16(1);2、专利申请号为200710144677.2,名称为“大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法”。
发明内容
本发明针对现有技术的不足,提出一种基于双积分重力矢量的并行解析粗对准方法和基于比力信息的精对准方法。该方法可实现光纤捷联罗经系统在晃动基座下自主对准。本发明的目的是这样实现的:
本发明包括下列步骤:
步骤1定义坐标系。光纤捷联罗经系统以东北天坐标系为导航坐标系n系;载体坐标系b系以载体中心为原点,x轴沿横轴指向右,y轴沿纵轴指向前,z轴垂直载体指向上;经线地球坐标系e系以地球中心为原点,并与地球固连,x、y轴在地球赤道平面内,x轴指向载体所在点经线,z轴指向地球自转轴方向;经线地心惯性坐标系i系定义为在粗对准起始时刻将地球坐标系惯性凝固成的右手坐标系;载体惯性坐标系ib0系定义为在粗对准起始时刻将载体坐标系惯性凝固后的坐标系。
在不同起始时刻并行运行r个基于双积分重力矢量的姿态矩阵计算过程,在最后同一时刻获得r个姿态矩阵值,对r个姿态矩阵值进行融合以提高粗对准结果的可靠性,并通过所述的初始姿态矩阵提取载体的方位角H、纵摇角P和横摇角R以完成粗对准。所述的初始姿态矩阵为
步骤3.1计算导航坐标系与经线地球坐标系之间的转移矩阵
步骤3.2计算经线地球坐标系与惯性坐标系之间的转移矩阵
式中,
步骤4建立以失准角为系统状态,以比力信息为系统量测的光纤捷联罗经系统精对准的卡尔曼滤波模型。
以三个失准角构造系统状态,以比力信息构造系统量测,得到滤波模型:
Y(t)=H(t)X(t)+V(t)
系统状态向量为X=[φe,φn,φu]T,系统矩阵F(t)为:
系泊情况下,由于忽略了晃动引起的干扰加速度,导航坐标系下的东向比力和北向比力为零,则加速度计的输出在导航坐标系下投影的水平分量即为与失准角耦合信息,系统量测Y为:
式中,g为当地的重力加速度值,g=9.8m/s2。
对滤波模型进行离散化处理,即得到离散卡尔曼滤波模型。
本发明包括下列有益结果:
本发明的方法具有如下优点:(1)标准的凝固对准算法对重力矢量进行单积分平滑在一定程度上抑制了基座晃动引起的角运动和线运动扰动以及传感器噪声的影响,但仍然存在波动,从而导致粗对准结果的离散程度较大。本发明的粗对准算法通过重力矢量的双积分运算和并行融合运算两种技术手段,对系统随机误差进行了平滑抑制,减小了的波动,提高了对准精度和可靠性;(2)精对准算法的系统状态维数仅有3维,量测维数仅有2维,滤波模型简单,计算量小。
对以上发明的有益效果说明如下:本实验利用光纤捷联罗经系统样机进行摇摆台试验,光纤陀螺的精度为0.05°/h(1σ),加速度计的精度为1mg(1σ)。并行运算的基于双积分重力矢量解析粗对准时间为5min,精对准的滤波周期为10s,精对准运行20min时统计对准结果,整个对准时间为25min。
表1摇摆台试验结果统计表
附图说明
图1为本发明的算法流程图。
图2为本发明的基于双积分重力矢量的并行解析对准算法时序图。
图3为本发明的双积分重力矢量解析对准算法流程图。
图4为本发明的精对准算法流程图。
图5为本发明的摇摆台试验的方位对准误差曲线图。
具体实施方式
下面举例对本发明做详尽描述:
在不同起始时刻并行运行r个基于双积分重力矢量的姿态矩阵计算过程,在最后同一时刻获得r个姿态矩阵值,对r个姿态矩阵值进行融合以提高粗对准结果的可靠性,并通过所述的初始姿态矩阵提取载体的方位角H、纵摇角P和横摇角R以完成粗对准。所述的初始姿态矩阵为
①计算导航坐标系与经线地球坐标系之间的转移矩阵
式中,
(4)建立以失准角为系统状态,以比力信息为系统量测的光纤捷联罗经系统精对准的卡尔曼滤波模型。
以三个失准角构造系统状态,以比力信息构造系统量测,得到滤波模型:
Y(t)=H(t)X(t)+V(t)
系统状态向量为X=[φe,φn,φu]T,系统矩阵F(t)为:
系泊情况下,由于忽略了晃动引起的干扰加速度,导航坐标系下的东向比力和北向比力为零,则加速度计的输出在导航坐标系下投影的水平分量即为与失准角耦合信息,系统量测Y为:
量测矩阵H(t)为:
式中,g为当地的重力加速度值,g=9.8m/s2。
对滤波模型进行离散化处理,即得到离散卡尔曼滤波模型。
Claims (1)
1.一种光纤捷联罗经系统的对准方法,其特征在于,包括以下步骤:
步骤1定义坐标系:光纤捷联罗经系统以东北天坐标系为导航坐标系n系;载体坐标系b系以载体中心为原点,x轴沿横轴指向右,y轴沿纵轴指向前,z轴垂直载体指向上;经线地球坐标系e系以地球中心为原点,x、y轴在地球赤道平面内,x轴指向载体所在点经线,z轴指向地球自转轴方向;经线地心惯性坐标系i系定义为在粗对准起始时刻将地球坐标系惯性凝固成的右手坐标系;载体惯性坐标系ib0系定义为在粗对准起始时刻将载体坐标系惯性凝固后的坐标系,
在不同起始时刻并行运行r个基于双积分重力矢量的姿态矩阵计算过程,在最后同一时刻获得r个姿态矩阵值,对r个姿态矩阵值进行融合以提高粗对准结果的可靠性,并通过所述的初始姿态矩阵提取载体的方位角H、纵摇角P和横摇角R以完成粗对准,所述的初始姿态矩阵为
其中,为中间姿态矩阵,并且,
式中,
步骤4建立以失准角为系统状态,以比力信息为系统量测的光纤捷联罗经系统精对准的卡尔曼滤波模型,
以三个失准角构造系统状态,以比力信息构造系统量测,得到滤波模型:
Y(t)=H(t)X(t)+V(t)
系统状态向量为X=[φe,φn,φu]T,系统矩阵F(t)为:
系泊情况下,忽略晃动引起的干扰加速度,导航坐标系下的东向比力和北向比力为零,则加速度计的输出在导航坐标系下投影的水平分量即为与失准角耦合信息,系统量测Y为:
式中,g为当地的重力加速度值,g=9.8m/s2,
对滤波模型进行离散化处理,即得到离散卡尔曼滤波模型,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110225420 CN102305635B (zh) | 2011-08-08 | 2011-08-08 | 一种光纤捷联罗经系统的对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110225420 CN102305635B (zh) | 2011-08-08 | 2011-08-08 | 一种光纤捷联罗经系统的对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102305635A true CN102305635A (zh) | 2012-01-04 |
CN102305635B CN102305635B (zh) | 2013-12-25 |
Family
ID=45379519
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110225420 Expired - Fee Related CN102305635B (zh) | 2011-08-08 | 2011-08-08 | 一种光纤捷联罗经系统的对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102305635B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102829781A (zh) * | 2012-08-29 | 2012-12-19 | 东南大学 | 一种旋转式捷联光纤罗经实现的方法 |
CN103453917A (zh) * | 2013-09-04 | 2013-12-18 | 哈尔滨工程大学 | 一种双轴旋转式捷联惯导系统初始对准与自标校方法 |
CN103557871A (zh) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
CN105393283A (zh) * | 2013-06-28 | 2016-03-09 | 微软技术许可有限责任公司 | 增强现实体验的重投影oled显示 |
CN106052715A (zh) * | 2016-05-23 | 2016-10-26 | 西北工业大学 | 单轴旋转捷联惯导系统回溯式自对准方法 |
CN108279025A (zh) * | 2017-12-22 | 2018-07-13 | 中国船舶重工集团公司第七0七研究所 | 一种基于重力信息的光纤陀螺罗经快速精对准方法 |
CN109631938A (zh) * | 2018-12-28 | 2019-04-16 | 湖南海迅自动化技术有限公司 | 掘进机自主定位定向系统及方法 |
CN115486815A (zh) * | 2022-06-27 | 2022-12-20 | 青岛大学 | 一种帕金森病手颤的三维姿态实时分析系统及方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101246022A (zh) * | 2008-03-21 | 2008-08-20 | 哈尔滨工程大学 | 基于滤波的光纤陀螺捷联惯导系统两位置初始对准方法 |
US20090089001A1 (en) * | 2007-08-14 | 2009-04-02 | American Gnc Corporation | Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS) |
CN101571394A (zh) * | 2009-05-22 | 2009-11-04 | 哈尔滨工程大学 | 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法 |
-
2011
- 2011-08-08 CN CN 201110225420 patent/CN102305635B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090089001A1 (en) * | 2007-08-14 | 2009-04-02 | American Gnc Corporation | Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS) |
CN101246022A (zh) * | 2008-03-21 | 2008-08-20 | 哈尔滨工程大学 | 基于滤波的光纤陀螺捷联惯导系统两位置初始对准方法 |
CN101571394A (zh) * | 2009-05-22 | 2009-11-04 | 哈尔滨工程大学 | 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法 |
Non-Patent Citations (1)
Title |
---|
经张俊,程向红,王宇: "《捷联罗经的动基座自对准技术》", 《中国惯性技术学报》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102829781A (zh) * | 2012-08-29 | 2012-12-19 | 东南大学 | 一种旋转式捷联光纤罗经实现的方法 |
CN102829781B (zh) * | 2012-08-29 | 2014-12-10 | 东南大学 | 一种旋转式捷联光纤罗经实现的方法 |
CN105393283A (zh) * | 2013-06-28 | 2016-03-09 | 微软技术许可有限责任公司 | 增强现实体验的重投影oled显示 |
CN103453917A (zh) * | 2013-09-04 | 2013-12-18 | 哈尔滨工程大学 | 一种双轴旋转式捷联惯导系统初始对准与自标校方法 |
CN103557871A (zh) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
CN103557871B (zh) * | 2013-10-22 | 2016-06-15 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
CN106052715A (zh) * | 2016-05-23 | 2016-10-26 | 西北工业大学 | 单轴旋转捷联惯导系统回溯式自对准方法 |
CN106052715B (zh) * | 2016-05-23 | 2018-11-23 | 西北工业大学 | 单轴旋转捷联惯导系统回溯式自对准方法 |
CN108279025A (zh) * | 2017-12-22 | 2018-07-13 | 中国船舶重工集团公司第七0七研究所 | 一种基于重力信息的光纤陀螺罗经快速精对准方法 |
CN108279025B (zh) * | 2017-12-22 | 2020-05-19 | 中国船舶重工集团公司第七0七研究所 | 一种基于重力信息的光纤陀螺罗经快速精对准方法 |
CN109631938A (zh) * | 2018-12-28 | 2019-04-16 | 湖南海迅自动化技术有限公司 | 掘进机自主定位定向系统及方法 |
CN115486815A (zh) * | 2022-06-27 | 2022-12-20 | 青岛大学 | 一种帕金森病手颤的三维姿态实时分析系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102305635B (zh) | 2013-12-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102305635B (zh) | 一种光纤捷联罗经系统的对准方法 | |
CN105180968B (zh) | 一种imu/磁强计安装失准角在线滤波标定方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN104165638B (zh) | 一种双轴旋转惯导系统多位置自主标定方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN103471616B (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN103776446B (zh) | 一种基于双mems-imu的行人自主导航解算算法 | |
CN102829781A (zh) | 一种旋转式捷联光纤罗经实现的方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN101706284B (zh) | 提高船用光纤陀螺捷联惯导系统定位精度的方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN105737823A (zh) | 基于五阶ckf的gps/sins/cns组合导航方法 | |
CN104236586B (zh) | 基于量测失准角的动基座传递对准方法 | |
CN101514900A (zh) | 一种单轴旋转的捷联惯导系统初始对准方法 | |
CN103245359A (zh) | 一种惯性导航系统中惯性传感器固定误差实时标定方法 | |
CN105865455A (zh) | 一种利用gps与加速度计计算飞行器姿态角的方法 | |
CN105043415A (zh) | 基于四元数模型的惯性系自对准方法 | |
CN106767925A (zh) | 带双轴转位机构的惯导系统三位置参数辨识对准方法 | |
CN103017787A (zh) | 适用于摇摆晃动基座的初始对准方法 | |
CN106017452A (zh) | 双陀螺抗扰动寻北方法 | |
CN102645223A (zh) | 一种基于比力观测的捷联惯导真空滤波修正方法 | |
CN108592943A (zh) | 一种基于opreq方法的惯性系粗对准计算方法 | |
CN107270937A (zh) | 一种离线小波降噪快速初始对准方法 | |
CN106840201A (zh) | 一种带双轴转位机构捷联惯导的三位置自对准方法 | |
CN103983274A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20131225 |
|
CF01 | Termination of patent right due to non-payment of annual fee |