CN101943582A - 基于ccd星敏感器与加速度计的惯性导航定位方法 - Google Patents
基于ccd星敏感器与加速度计的惯性导航定位方法 Download PDFInfo
- Publication number
- CN101943582A CN101943582A CN 201010215321 CN201010215321A CN101943582A CN 101943582 A CN101943582 A CN 101943582A CN 201010215321 CN201010215321 CN 201010215321 CN 201010215321 A CN201010215321 A CN 201010215321A CN 101943582 A CN101943582 A CN 101943582A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- star sensor
- information
- accelerometer
- navigation
- 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
Images
Landscapes
- Navigation (AREA)
Abstract
Description
技术领域
本发明涉及的是一种导航定位方法,特别是涉及一种惯性导航定位方法。
背景技术
惯性导航系统是一种利用加速度计和陀螺仪测得载体的加速度和角速度,经过运算求得载体即时位置的导航设备,是一种自主式的导航系统。惯导系统工作时既不向外界发射、也不接收外界的任何电磁波信号。因此,它具有自主、隐蔽、实时及不受地域、时间和气候条件限制的特点,能够方便的提供载体的三维姿态参数。惯导系统分为捷联式和平台式的惯导系统,两种惯导系统工作的原理是一样的。在计算姿态矩阵时,不论上述那种惯导系统中,都是应用陀螺来测得角速度,通过一定的物理机械控制或者一定的算法来浮现姿态矩阵,由于陀螺本身存在漂移,所以在长时间导航工作时,惯导系统中的姿态矩阵会随着时间的推移而变坏。为满足长时间能够保持姿态矩阵的准确性,人们利用监控器或者旋转调制方法来尽量去减小这种不确定的漂移误差,应用上述的方法在很大程度上都能满足了人们现有的要求。目前,应用最为广泛的陀螺仪器为激光陀螺和光纤陀螺,激光陀螺以美国为主导,光纤陀螺以法国为主导,激光陀螺漂移可以达到0.0001°/h;光纤陀螺漂移可以达到0.0005°/h。虽然陀螺漂移可以通过现有的技术进一步去改进,不过它是一个随时间推移而递增的量,在某些特定的设备或者仪器上,需要长达几十天或者几个月的工作时间,如何满足这样的要求就是发展半惯性导航系统的重点。
为满足上述设备或者仪器的长时间的工作周期,CCD星敏感器误差是不随着时间的推移而递增的,并且星敏感器本身可以间接输出姿态矩阵,利用上述的特点可以应用其替代陀螺,在CCD星敏感器件中添加三个加速度计,通过姿态矩阵信息进行三轴加速度的分解,达到导航的目的。半惯性测量装置具有体积小、耗电少、寿命长、可靠性高、抗高过载等优点,可以满足现代导航设备各方面的要求。
发明内容
本发明的目的在于提供一种能够有效提高导航设备定位精度的基于CCD星敏感器与加速度计的惯性导航定位方法。
本发明的目的是这样实现的,包括下列步骤:
(1)初始对准完毕以后,采集石英挠性加速度计的输出数据;
(3)采集无误差状态下的惯性导航算法中输出的定位信息,得到地球坐标系即e系相对于导航坐标系即n系的转换矩阵
(5)通过(1)、(2)、(3)、(4)所给出的信息,解算得到姿态矩阵:
解算出姿态信息;
(6)通过步骤(5)中的解算的姿态信息,将加速度计从载体坐标系转换到导航坐标系上,完成速度解算,输出载体速度和导航定位信息。
本发明还可以包括如下特征:
则运载体(b系)相对于惯性系(i系)之间的关系为:
通过CCD星敏感器自身携带的世界标准时间系统,可以得到:
wie为地球自转角速度,t是世界标准时间系统提供的具体时间,Aj是初始位置(经度和纬度)与春分点之间的夹角。
在(4)中,由(3)式提供,由(3)计算可得,地球坐标系(e系)相对于导航坐标系(n系)的转换矩阵可以通过惯性算法得到,算法中得到的信息包括一定的误差,计算的位置矩阵与真实的位置矩阵之间的转换矩阵为Ca。即:
本发明的方法具有以下优点:
(1)本发明是一种惯性导航算法,有位置信息反馈,因此具有周期性;
(2)CCD星敏感器和加速度计误差会带来一定的误差,误差不是很大,定位精度高。
对本发明的有益效果说明如下:
Matlab仿真
(1)在以下的仿真条件下,对该方法进行仿真实验:
载体初始位置:北纬45.7796°,东经126.6705°;
载体真实姿态角:ψ=0°,θ=5°,γ=5°;其中:ψ,θ,γ分别表示航向角、纵摇角和横摇角;
赤道半径:Re=6378393.0m;
由万有引力可得的地球表面重力加速度:g0=9.78049;
地球自转角速度(弧度/秒):7.2921158e-5;
加速度计零偏:0米/秒方;
CCD星敏感器的误差:η=0°;
常数:π=3.1415926;
仿真时间:t=1小时;
采样频率:Hn=0.1;
利用发明所述方法得到定位误差如图1所示;如果不存在加速度计零偏和CCD星敏感误差的情况下,定位误差为0米。
(2)在以下的仿真条件下,对该方法进行仿真实验:
载体初始位置:北纬45.7796°,东经126.6705°;
载体真实姿态角:ψ=0°,θ=5°,γ=5°;其中:ψ,θ,γ分别表示航向角、纵摇角和横摇角;
赤道半径:Re=6378393.0m;
由万有引力可得的地球表面重力加速度:g0=9.78049;
地球自转角速度(弧度/秒):7.2921158e-5;
加速度计零偏:0米/秒方;
CCD星敏感器的误差:η=0.0028°;
常数:π=3.1415926;
仿真时间:t=3小时;
采样频率:Hn=0.1;
利用发明所述方法得到定位误差如图2所示;如果不存在加速度零偏,存在CCD星敏感器误差的情况下,3小时的定位精度大约为0.4海里,并且随时间的推移在成周期性振荡。
(3)在以下的仿真条件下,对该方法进行仿真实验:
载体初始位置:北纬45.7796°,东经126.6705°;
载体真实姿态角:ψ=0°,θ=5°,γ=5°;其中:ψ,θ,γ分别表示航向角、纵摇角和横摇角;
赤道半径:Re=6378393.0m;
由万有引力可得的地球表面重力加速度:g0=9.78049;
地球自转角速度(弧度/秒):7.2921158e-5;
加速度计零偏:1×10-4×g0米/秒方;
CCD星敏感器的误差:η=0°;
常数:π=3.1415926;
仿真时间:t=3小时;
采样频率:Hn=0.1;
利用发明所述方法得到定位误差如图3所示;如果不存在CCD星敏感器误差,存在加速度计零偏的情况下,3小时初始定位精度大约为1海里。
(4)在以下的仿真条件下,对该方法进行仿真实验:
载体初始位置:北纬45.7796°,东经126.6705°;
载体真实姿态角:ψ=0°,θ=5°,γ=5°;其中:ψ,θ,γ分别表示航向角、纵摇角和横摇角;
赤道半径:Re=6378393.0m;
由万有引力可得的地球表面重力加速度:g0=9.78049;
地球自转角速度(弧度/秒):7.2921158e-5;
加速度计零偏:1×10-4×g0米/秒方;
CCD星敏感器的误差:η=0.0028°;
常数:π=3.1415926;
仿真时间:t=3小时;
采样频率:Hn=0.1;
利用发明所述方法得到定位误差如图4所示;如果存在CCD星敏感器误差和加速度零偏的情况下,3小时的定位精度大约为1.39海里。
(5)在以下的仿真条件下,对该方法进行仿真实验:
载体初始位置:北纬45.7796°,东经126.6705°;
载体真实姿态角:ψ=0°,θ=5°,γ=5°;其中:ψ,θ,γ分别表示航向角、纵摇角和横摇角;
赤道半径:Re=6378393.0m;
由万有引力可得的地球表面重力加速度:g0=9.78049;
地球自转角速度(弧度/秒):7.2921158e-5;
加速度计零偏:1×10-4×g0米/秒方;
CCD星敏感器的误差:η=0.0028°;
常数:π=3.1415926;
仿真时间:t=12小时;
采样频率:Hn=0.1;
利用发明所述方法得到定位误差如图6所示;如果存在CCD星敏感器误差和加速度零偏的情况下,12小时的定位精度大约为1.39海里。
附图说明
图1为利用Matlab仿真得到的定位误差曲线图;
图2为利用Matlab仿真得到的定位误差曲线图;
图3为利用Matlab仿真得到的定位误差曲线图;
图4为利用Matlab仿真得到的定位误差曲线图;
图5为利用Matlab仿真得到的定位误差曲线图;
图6为发明的步骤流程框图。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1.
(1)初始对准完毕以后,采集石英挠性加速度计的输出数据;
i系与船舶载体坐标系(b系)之间的转换矩阵:
将天球坐标系O-UVW按照先绕W轴逆时针转w角,得到O-U1V1W1坐标系,再绕U1逆时针转u角,使W1轴与Zs重合,得到O-U2V2W2坐标系,最后再绕W2轴逆时针旋转v角,得到Os-UsVsWs坐标系。
wie为地球自转角速度,t是世界标准时间系统提供的具体时间,Aj是初始位置(经度和纬度)与春分点之间的夹角。
在(5)中,由(3)式提供,由(4)计算可得,地球坐标系(e系)相对于导航坐标系(n系)的转换矩阵可以通过惯性算法得到,算法中得到的信息包括一定的误差,计算的位置矩阵与真实的位置矩阵之间的转换矩阵为Ca。即:
Claims (1)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201010215321 CN101943582A (zh) | 2010-07-02 | 2010-07-02 | 基于ccd星敏感器与加速度计的惯性导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201010215321 CN101943582A (zh) | 2010-07-02 | 2010-07-02 | 基于ccd星敏感器与加速度计的惯性导航定位方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN101943582A true CN101943582A (zh) | 2011-01-12 |
Family
ID=43435699
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201010215321 Pending CN101943582A (zh) | 2010-07-02 | 2010-07-02 | 基于ccd星敏感器与加速度计的惯性导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101943582A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102410842A (zh) * | 2011-07-26 | 2012-04-11 | 西安费斯达自动化工程有限公司 | 基于铅垂陀螺和ccd线阵的姿态可视化测量方法 |
CN102426020A (zh) * | 2011-09-01 | 2012-04-25 | 中国航空工业第六一八研究所 | 一种航姿系统的地球自转误差补偿方法 |
CN102707080A (zh) * | 2011-10-21 | 2012-10-03 | 哈尔滨工程大学 | 一种星敏感器模拟捷联惯导陀螺的方法 |
CN102997917A (zh) * | 2011-09-15 | 2013-03-27 | 北京自动化控制设备研究所 | 一种基于惯性/gps信息高频导航基准构造方法 |
CN103389096A (zh) * | 2013-07-29 | 2013-11-13 | 哈尔滨工程大学 | 一种惯性导航系统横子午线曲率半径的测量方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001523006A (ja) * | 1997-11-11 | 2001-11-20 | ローマル,フランツ,ヨゼフ | 可視障害物によって少なくとも部分的に包囲された地点の衛星測定のための測定期間を決定するための方法及び装置 |
US20050162533A1 (en) * | 1998-07-27 | 2005-07-28 | Sony Corporation | Image pickup apparatus, navigation apparatus and IC card |
CN1851408A (zh) * | 2006-05-31 | 2006-10-25 | 哈尔滨工业大学 | 基于多天体路标的星际巡航自主导航方法 |
CN1869589A (zh) * | 2006-06-27 | 2006-11-29 | 北京航空航天大学 | 一种捷联惯性/天文组合导航半实物仿真系统 |
-
2010
- 2010-07-02 CN CN 201010215321 patent/CN101943582A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001523006A (ja) * | 1997-11-11 | 2001-11-20 | ローマル,フランツ,ヨゼフ | 可視障害物によって少なくとも部分的に包囲された地点の衛星測定のための測定期間を決定するための方法及び装置 |
US20050162533A1 (en) * | 1998-07-27 | 2005-07-28 | Sony Corporation | Image pickup apparatus, navigation apparatus and IC card |
CN1851408A (zh) * | 2006-05-31 | 2006-10-25 | 哈尔滨工业大学 | 基于多天体路标的星际巡航自主导航方法 |
CN1869589A (zh) * | 2006-06-27 | 2006-11-29 | 北京航空航天大学 | 一种捷联惯性/天文组合导航半实物仿真系统 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102410842A (zh) * | 2011-07-26 | 2012-04-11 | 西安费斯达自动化工程有限公司 | 基于铅垂陀螺和ccd线阵的姿态可视化测量方法 |
CN102426020A (zh) * | 2011-09-01 | 2012-04-25 | 中国航空工业第六一八研究所 | 一种航姿系统的地球自转误差补偿方法 |
CN102426020B (zh) * | 2011-09-01 | 2014-03-19 | 中国航空工业第六一八研究所 | 一种航姿系统的地球自转误差补偿方法 |
CN102997917A (zh) * | 2011-09-15 | 2013-03-27 | 北京自动化控制设备研究所 | 一种基于惯性/gps信息高频导航基准构造方法 |
CN102997917B (zh) * | 2011-09-15 | 2015-10-14 | 北京自动化控制设备研究所 | 一种基于惯性/gps信息高频导航基准构造方法 |
CN102707080A (zh) * | 2011-10-21 | 2012-10-03 | 哈尔滨工程大学 | 一种星敏感器模拟捷联惯导陀螺的方法 |
CN102707080B (zh) * | 2011-10-21 | 2014-06-25 | 哈尔滨工程大学 | 一种星敏感器模拟捷联惯导陀螺的方法 |
CN103389096A (zh) * | 2013-07-29 | 2013-11-13 | 哈尔滨工程大学 | 一种惯性导航系统横子午线曲率半径的测量方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101514900B (zh) | 一种单轴旋转的捷联惯导系统初始对准方法 | |
CN101881619B (zh) | 基于姿态测量的船用捷联惯导与天文定位方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN101514899B (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN104165641B (zh) | 一种基于捷联惯导/激光测速仪组合导航系统的里程计标定方法 | |
CN101706287B (zh) | 一种基于数字高通滤波的旋转捷联系统现场标定方法 | |
CN103076015B (zh) | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 | |
CN100541132C (zh) | 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法 | |
CN102829781B (zh) | 一种旋转式捷联光纤罗经实现的方法 | |
CN101713666B (zh) | 一种基于单轴转停方案的系泊估漂方法 | |
CN103090867A (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航系统误差抑制方法 | |
CN101629826A (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法 | |
CN103471616A (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN101718560A (zh) | 基于单轴四位置转停方案的捷联系统误差抑制方法 | |
CN101915579A (zh) | 一种基于ckf的sins大失准角初始对准新方法 | |
CN102788598B (zh) | 基于三轴旋转的光纤捷联惯导系统误差抑制方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN103727941A (zh) | 基于载体系速度匹配的容积卡尔曼非线性组合导航方法 | |
CN103090866A (zh) | 一种单轴旋转光纤陀螺捷联惯导系统速度误差抑制方法 | |
CN102628691A (zh) | 一种完全自主的相对惯性导航方法 | |
CN103900571A (zh) | 一种基于惯性坐标系旋转型捷联惯导系统的载体姿态测量方法 | |
CN103256943A (zh) | 一种在单轴旋转捷联惯导系统中刻度因数误差的补偿方法 | |
CN103454662B (zh) | 一种基于ckf的sins/北斗/dvl组合对准方法 | |
CN102707080B (zh) | 一种星敏感器模拟捷联惯导陀螺的方法 | |
CN102768043A (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 | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20110112 |