亚星游戏官网-www.yaxin868.com

专利名称：基于姿态测量的船用捷联惯导与天文定位方法
技术领域：
本发明涉及的是一种导航定位方法，特别是涉及一种捷联惯导与天文导航定位技 术。
背景技术：
(XD星敏感器作为一种高精度的姿态测量仪器，具有体积小、适装性强、测量误差 不随时间积累等优点，不仅在宇宙飞船和卫星等空间飞行器中得到了应用，而且在舰艇和 导弹上的应用也越来越广泛。传统的天文导航是以平台惯导或平台罗经来提供水平基准， 利用CCD星敏感器来进行观测出太空中某一位置的几颗恒星，并利用自身携带的星图库进 行比较，计算出光轴的赤经和赤纬，进而利用天文三角形的算法来计算运载体的地理位置 (经度和纬度)，定位精度高。然而平台惯性系统(平台惯导和平台罗经)需要有精确的物 理平台，因而体积大、硬件系统复杂、可靠性低、成本高而且难以维护等一系列的缺点，已逐 渐被捷联惯导系统取代。为了适应这一不可逆转的变化，研究捷联惯导/天文定位方法就 显得十分必要。捷联惯导系统是把把惯性仪表直接固联在载体上，利用“数学平台”代替平台惯性 系统中的物理平台，因而具有体积小、重量轻、成本低、可靠性高、便于维护、适装性强等优 点，得到越来越广泛的应用。然而受原理的限制，捷联惯导系统的定位误差随着时间的积累 而发散，不能进行长时间、高质量的定位；考虑到捷联惯导系统输出的姿态不随着时间的积 累而发散，如何利用捷联惯导中姿态不发散的性质与对CCD星敏感器测量姿态进行处理， 得到位置矩阵，从而获得准确的位置信息就显的尤为必要。

发明内容
本发明的目的在于提供一种能够有效提高导航设备定位精度的基于姿态测量的 船用捷联惯导与天文定位方法。本发明的目的是这样实现的包括下列步骤(1)在捷联惯导系统初始对准完毕以后，采集光纤陀螺仪和石英挠性加速度计的 输出数据；(2)采集(XD星敏感器的输出，即(XD星敏感器的坐标系相对于惯性坐标系即i系 之间的姿态信息Cf，i系与船舶载体坐标系即b系之间的转换矩阵为Cf =CbsC其中:Cbs为(XD星敏感器坐标系即s系与b系之间的转换矩阵，它在导航设备装船 时通过光学瞄准精确获得；(3)采集惯导系统连续输出的姿态矩阵CA"’，其中计算地理坐标系即n'系，当地地 理坐标系即n系与计算当地地理坐标系n'之间的转化矩阵为C "’ ；(4)求解地球坐标系即e系相对于i系之间的转换矩阵Cf ；

(5)通过(1)、(2)、(3)、⑷所得到的信息，解算得到位置矩阵:C:’《饮 根据C；1'解算出位置信息。
所述解算出位置信息的具体方法为 C；=
确定(XD星敏感器的输出G，
运载体b系相对于惯性系i系之间的关系为=CbsC；， 通过CCD星敏感器自身携带的世界标准时间系统，得到 cos(Aj+wie -t) sin{Aj+wie -t) 0 -t) cos{Aj+wie-t) 0 0 0 1_wie为地球自转角速度、t是世界标准时间系统提供的具体时间、Aj是初始位置即 经度和纬度与春分点之间的夹角；c^ =cbn,cnn'c"eqC 6由捷联惯导系统输出提供，当地地理坐标系n系与计算当地地理坐标系n'之 间的转换矩阵为c "’，通过得位置矩阵ce"’，通过位置矩阵实时的计算出船舶 的位置即经度和纬度；
通过
确定船舶的经度主值和纬度主值


纬度的真实值识为
经度的真实值入为至此完成导航定位计算。本发明的方法具有以下优点(1)捷联航姿系统输出水平的两个失准角误差也是不发散的，所以捷联式惯性天 文导航定位算法是无积累的导航定位算法；(2)陀螺漂移会带来一定的误差，误差不是很大，导航定位在一定范围内振荡，定 位精度高。
对本发明的有益效果说明如下Mat lab 仿真(1)在以下的仿真条件下，对该方法进行仿真实验捷联航姿系统处于静止状态；载体初始位置北纬45. 7796°，东经126. 6705° ；载体真实姿态误差角V = 0°，0 = 0°，Y = 0° ；其中V，9 , Y分别表示 航向误差角、纵摇误差角和横摇误差角；赤道半径:Re= 6378393. 0m ；由万有引力可得的地球表面重力加速度gQ = 9. 78049 ；地球自转角速度(弧度/秒)7. 2921158e-5 ；陀螺仪常值漂移0度/小时；加速度计零偏0米/秒方；CCD星敏感器的误差n = 0. 0028° ；常数Ji= 3. 1415926 ；仿真时间t = 3小时；采样频率Hn= 0. 1 ；利用发明所述方法得到经度误差、纬度误差、定位误差分别如图1、图2、图3所示； 如果不存在陀螺漂移和初始对准误差的情况下，定位精度高，3小时定位精度大约为11. 3米。(2)在以下的仿真条件下，对该方法进行仿真实验
捷联航姿系统处于静止状态；载体初始位置北纬45. 7796°，东经126. 6705° ；载体真实姿态误差角V = 0°，0 = 0°，Y = 0° ；其中V，9 , Y分别表示 航向误差角、纵摇误差角和横摇误差角；赤道半径Re= 6378393. Om ；由万有引力可得的地球表面重力加速度gQ = 9. 78049 ；地球自转角速度(弧度/秒)7. 2921158e-5 ；陀螺仪常值漂移0. 01度/小时；加速度计零偏1 X 10_4 X gQ米/秒方；CCD星敏感器的误差n = 0. 0028° ；常数JI= 3. 1415926 ；仿真时间{ = 3小时；采样频率Hn= 0. 1 ；利用发明所述方法得到经度误差、纬度误差、定位误差分别如图4、图5、图6所示； 如果存在陀螺漂移，初始对准误差为零的情况下，3小时的定位精度大约为0. 94海里，并且 随时间的推移在成周期性振荡。(3)在以下的仿真条件下，对该方法进行仿真实验捷联航姿系统处于静止状态；载体初始位置北纬45. 7796°，东经126.6705° ；
载体真实姿态误差角=0.02°，e = 0.01°，Y = 0.01° ；其中v，e，Y 分别表示航向误差角、纵摇误差角和横摇误差角；赤道半径:Re= 6378393. 0m ；由万有引力可得的地球表面重力加速度gQ = 9. 78049 ；地球自转角速度(弧度/秒)7. 2921158e-5 ；陀螺仪常值漂移0度/小时；加速度计零偏1 X 10_4X gQ米/秒方；CCD星敏感器的误差n = 0. 0028° ；常数Ji= 3. 1415926 ；仿真时间:t = 3小时;采样频率Hn= 0. 1 ；利用发明所述方法得到经度误差、纬度误差、定位误差分别如图7、图8、图9所示； 如果不存在陀螺漂移，初始对准误差为0.02°、0.01°、0.01°的情况下，3小时初始定位 精度大约为1.4海里，起始位置出现误差。(4)在以下的仿真条件下，对该方法进行仿真实验捷联航姿系统处于静止状态；载体初始位置北纬45. 7796°，东经126.6705° ；载体真实姿态误差角v=0.02°，e = 0.01°，Y = 0.01° ；其中v，e，Y 分别表示航向误差角、纵摇误差角和横摇误差角；赤道半径Re= 6378393. Om ；由万有引力可得的地球表面重力加速度gQ = 9. 78049 ；地球自转角速度(弧度/秒)7. 2921158e-5 ；陀螺仪常值漂移0. 01度/小时；加速度计零偏1 X 10_4X gQ米/秒方；CCD星敏感器的误差n = 0. 0028° ；常数JI= 3. 1415926 ；仿真时间:t = 3小时;采样频率Hn= 0. 1 ；利用发明所述方法得到经度误差、纬度误差、定位误差分别如图10、图11、图12所 示；如果存在陀螺漂移并且初始对准误差为0.02°、0.01°、0.01°的情况下，3小时的定 位精度大约为1. 39海里，起始位置存在一定的初始定位误差。


图1为利用Matlab仿真得到的经度误差曲线图(第一组仿真实验)；图2为利用Matlab仿真得到的纬度误差曲线图(第一组仿真实验)；图3为利用Matlab仿真得到的定位误差曲线图(第一组仿真实验)；图4为利用Matlab仿真得到的经度误差曲线图(第二组仿真实验)；图5为利用Matlab仿真得到的纬度误差曲线图(第二组仿真实验)；图6为利用Matlab仿真得到的定位误差曲线图(第二组仿真实验)；
图7为利用Matlab仿真得到的经度误差曲线图(第三组仿真实验)图8为利用Matlab仿真得到的纬度误差曲线图(第三组仿真实验)图9为利用Matlab仿真得到的定位误差曲线图(第三组仿真实验)图10为利用Matlab仿真得到的经度误差曲线图(第四组仿真实验)图11为利用Matlab仿真得到的纬度误差曲线图(第四组仿真实验)图12为利用Matlab仿真得到的定位误差曲线图(第四组仿真实验)图13为发明的步骤流程框图。
具体实施例方式下面举例对本发明做更详细地描述(1)在捷联惯导系统初始对准完毕以后(粗对准和精对准)，采集光纤陀螺仪和石 英挠性加速度计的输出数据；(2)采集C⑶星敏感器的输出C⑶星敏感器的坐标系相对于惯性坐标系(i系天 球坐标系)之间的姿态信息Cf，i系与船舶载体坐标系(b系)之间的转换矩阵 Cf = CbC
(1)其中:Cbs为(XD星敏感器坐标系(s系)与b系之间的转换矩阵，它可以在导航设 备装船时通过光学瞄准精确获得。将天球坐标系o-uvw按照先绕W轴逆时针转w角，得到0-UAWi坐标系，再绕Ui逆 时针转U角，使Wi轴与Zs重合，得到0-U2V2W2坐标系，最后再绕W2轴逆时针旋转V角，得到 os-usvsws 坐标系。 (3)釆集惯导系统连续输出的姿态矩阵Cf,其中计算地理坐标系(V 理坐标系(n系)与计算当地地理坐标系)之间的转化矩阵为(4)求解地球坐标系(e系)相对于i系之间的转换矩阵 cos(4 . t) sin(為 +w/e. 0 0" -sin(為+wie. t) cos(4 +wie t) 0 wie为地球自转角速度，t是世界标准时间系统提供的具体时间，Aj是初始位置(经 度和纬度)与春分点之间的夹角。cf = c 6c;'c;c;(4)在⑷中，0由⑴式提供，C A由捷联惯导系统输出提供，Cf由(3)计算可得，当地 地理坐标系(n系)与计算当地地理坐标系(n')之间的转化矩阵为C "'。通过(4)式得位 置矩阵Ce"’，通过位置矩阵就可以实时的计算出船舶的位置(经度和纬度)。 c;' = c;'ce"
(5)
设
通过(6)可以确定船舶的经度主值和纬度主值c (p生 二 sin-1 C33
纬度的真实值识为
经度的真实值入为
；L 二 j 4+180° 当 C31 <0时，；I主 <0时 ；I主-180° 当C31 < 0时，；I主 > 0时
至此，完成导航定位计算。
权利要求
一种基于姿态测量的船用捷联惯导与天文定位方法，其特征在于包括以下几个步骤(1)在捷联惯导系统初始对准完毕以后，采集光纤陀螺仪和石英挠性加速度计的输出数据；(2)采集CCD星敏感器的输出，即CCD星敏感器的坐标系相对于惯性坐标系即i系之间的姿态信息i系与船舶载体坐标系即b系之间的转换矩阵为其中为CCD星敏感器坐标系即s系与b系之间的转换矩阵，它在导航设备装船时通过光学瞄准精确获得；(3)采集惯导系统连续输出的姿态矩阵其中计算地理坐标系即n′系，当地地理坐标系即n系与计算当地地理坐标系n′之间的转化矩阵为(4)求解地球坐标系即e系相对于i系之间的转换矩阵(5)通过(1)、(2)、(3)、(4)所得到的信息，解算得到位置矩阵根据解算出位置信息。FSA00000177083700011.tif,FSA00000177083700012.tif,FSA00000177083700013.tif,FSA00000177083700014.tif,FSA00000177083700015.tif,FSA00000177083700016.tif,FSA00000177083700017.tif,FSA00000177083700018.tif
2.根据权利要求1所述的基于姿态测量的船用捷联惯导与天文定位方法，其特征是所 述解算出位置信息的具体方法为确定CXD星敏感器的输出，运载体b系相对于惯性系i系之间的关系为(Kc;， 通过CCD星敏感器自身携带的世界标准时间系统，得到 cos{Aj+wie -t) sin(y47+wie -t) 0 wie为地球自转角速度、t是世界标准时间系统提供的具体时间、Aj是初始位置即经度 和纬度与春分点之间的夹角； Cbi =CbnCnXneCei由捷联惯导系统输出提供，当地地理坐标系η系与计算当地地理坐标系η'之间的 转换矩阵为^，通过C，=CniCfCenG得位置矩阵Cf，通过位置矩阵实时的计算出船舶的位 置即经度和纬度； C:' =C:,C:, φ生-sin"1 C33 义主=tan纬度的真实值P为经度的真实值λ为 至此完成导航定位计算。
全文摘要
本发明提供的是一种基于姿态测量的船用捷联惯导与天文定位方法。(1)在捷联惯导系统初始对准完毕以后，采集光纤陀螺仪和石英挠性加速度计的输出数据；(2)采集CCD星敏感器的输出，即CCD星敏感器的坐标系相对于惯性坐标系即i系之间的姿态信息；(3)采集惯导系统连续输出的姿态矩阵；(4)求解地球坐标系即e系相对于i系之间的转换矩阵；(5)通过(1)、(2)、(3)、(4)所得到的信息，解算得到位置矩阵，根据位置矩阵解算出位置信息。本发明是无积累的导航定位算法；定位精度高。
文档编号G01C21/02GK101881619SQ20101020928
公开日2010年11月10日 申请日期2010年6月25日 优先权日2010年6月25日
发明者于强, 付建楠, 吴晓, 周广涛, 奔粤阳, 张勇刚, 张鑫, 徐博, 胡丹, 高伟 申请人:哈尔滨工程大学