CN106092100B - 将测量船惯导船摇数据等效至测控设备处的船摇等效方法 - Google Patents
将测量船惯导船摇数据等效至测控设备处的船摇等效方法 Download PDFInfo
- Publication number
- CN106092100B CN106092100B CN201610392497.5A CN201610392497A CN106092100B CN 106092100 B CN106092100 B CN 106092100B CN 201610392497 A CN201610392497 A CN 201610392497A CN 106092100 B CN106092100 B CN 106092100B
- Authority
- CN
- China
- Prior art keywords
- ship
- measuring
- equivalent
- equipment
- controlling equipment
- 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.)
- Expired - Fee Related
Links
Classifications
-
- 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/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种将测量船惯导船摇数据等效至测控设备处的船摇等效方法,所述方法包括以下步骤:根据惯导测量的船摇数据和惯导三轴交点在地心固联系下的大地坐标以及惯导平台至测控设备间变形欧拉角计算经度旋转矩阵、纬度旋转矩阵、船摇旋转矩阵和变形欧拉角矩阵;根据设备三轴中心在惯导甲板系中坐标以及经度、纬度、船摇三种旋转矩阵计算设备三轴中心在地心固联系下坐标;根据设备三轴中心在地心固联系下直角坐标计算其大地坐标;根据设备三轴中心在地心固联系下大地坐标计算设备的经度旋转矩阵和纬度旋转矩阵;计算设备等效船摇欧拉角矩阵;计算设备的船摇数据。
Description
技术领域
本发明涉及一种船摇等效方法,主要用于将惯导设备测量的船摇数据通过变形修正,等效计算到各个测控设备处。
背景技术
航天测量船在海上航行过程中因受风、浪、涌等多种因素的影响,会引起船体姿态发生复杂、不规则的运动。安装在船体甲板上的各种测量设备,同样受到这种不规则运动的影响。研究表明:测量船的测量精度不仅与外测设备本身精度有关,而且与测量船船体姿态、变形有关。为修正这种不规则运动对测量精度的影响,测量船安装了船载惯性导航设备用于实时测量测量船船位及船摇。由于惯导设备测量的是惯导三轴交点处的船体摇摆角,而测控设备三轴中心与惯导三轴中心不在同一位置,惯导测量的船摇角不能直接使用于测控设备船摇修正。因此在处理测量设备测量数据或计算测控设备引导数据时必须将惯导测量的船摇数据通过变形修正,等效计算到各个测控设备处。另外,如果测量船在不同位置安装多套船姿测量设备,在分析不同设备间船姿测量结果时,也需要将一套惯导船摇数据等效到另一套惯导设备处。船摇等效计算是多套船姿测量数据融合备份使用、不同测控设备精度比对的前提。
当前船摇等效计算时一般采用平移法。该方法认为设备地平坐标系与惯导地平坐标系坐标轴指向相同,即设备三轴中心水平面与惯导三轴交点水平面为同一平面。事实上,由于地球形状的影响,对于参考椭球体表面的不同位置,水平面都不相同,因此设备地平坐标系与惯导地平坐标系坐标轴指向存在差异。平移法计算船摇等效必然带来了较大的误差。
发明内容
本发明所要解决的技术问题是针对上述现有技术提供一种考虑地球形状的船摇等效计算法,可以显著提高船摇等效精度,进而提高外测数据精度。
本发明解决上述问题所采用的技术方案为:一种将测量船惯导船摇数据等效至测控设备处的船摇等效方法,所述方法包括以下步骤:
步骤A、根据惯导测量的船摇数据K,θ和惯导三轴交点在地心固联系下的大地坐标(λ,ω,h)以及惯导平台至测控设备间变形欧拉角(Kb,θb)计算经度旋转矩阵L、纬度旋转矩阵B、船摇旋转矩阵Bc和变形欧拉角矩阵Bb,其中K为艏摇,为纵摇,θ为横摇,λ为经度,ω为纬度,h为高程,
步骤B、根据测控设备三轴中心在惯导甲板系中坐标X0=[x0,y0,z0]T以及经度旋转矩阵L、纬度旋转矩阵B、船摇旋转矩阵Bc计算测控设备三轴中心在地心固联系下直角坐标:
Y1=LBBcX0+Y (5)
其中
e2为参考椭球体第一偏心率的平方,a为地球赤道半径;
步骤C、根据测控设备三轴中心在地心固联系下直角坐标Y1计算其大地坐标(λ1,ω1,h1),计算公式为
步骤D、根据测控设备三轴中心在地心固联系下大地坐标(λ1,h1)计算设备的经度旋转矩阵L1、纬度旋转矩阵B1,计算公式为
步骤E、计算测控设备等效船摇欧拉角矩阵Bc1,计算公式为:
步骤F、根据测控设备等效船摇欧拉角矩阵Bc1计算测控设备的船摇数据(K1,θ1),其中设计算公式为
与现有技术相比,本发明的优点在于:
理论分析和数据验证表明,考虑地球形状能够减少船摇等效计算过程中的系统误差,提高等效数据的精度,这将为测量船的船摇数据计算以及外测数据处理的精度提高提供支持。
附图说明
图1为本发明中船位经度等效船摇的影响仿真图。
图2为本发明中船位纬度等效船摇的影响仿真图。
图3为本发明中船位高程等效船摇的影响仿真图。
图4为本发明中测控设备视差对等效船摇的影响仿真图。
具体实施方式
以下结合附图实施例对本发明作进一步详细描述。
本实施例中的一种将测量船惯导船摇数据等效至测控设备处的船摇等效方法,其具体过程如下:
步骤A、根据惯导测量的船摇数据K,θ和惯导三轴交点在地心固联系下的大地坐标(λ,ω,h)以及惯导平台至测控设备间变形欧拉角(Kb,θb)计算经度旋转矩阵L、纬度旋转矩阵B、船摇旋转矩阵Bc和变形欧拉角矩阵Bb,其中K为艏摇,为纵摇,θ为横摇,λ为经度,ω为纬度,h为高程,
步骤B、根据测控设备三轴中心在惯导甲板系中坐标X0=[x0,y0,z0]T以及经度旋转矩阵L、纬度旋转矩阵B、船摇旋转矩阵Bc计算测控设备三轴中心在地心固联系下直角坐标
Y1=LBBcX0+Y (5)
其中
e2为参考椭球体第一偏心率的平方,a为地球赤道半径。
步骤C、根据设备三轴中心在地心固联系下直角坐标Y1计算其大地坐标(λ1,ω1,h1),计算公式为
步骤D、根据测控设备三轴中心在地心固联系下大地坐标(λ1,ω1,h1)计算设备的经度旋转矩阵L1、纬度旋转矩阵B1,计算公式为
步骤E、计算测控设备等效船摇欧拉角矩阵Bc1,计算公式为:
步骤F、根据测控设备等效船摇欧拉角矩阵Bc1计算测控设备的船摇数据(K1,θ1),其中设则计算公式为
本发明提供的一种将测量船惯导船摇数据等效至测控设备处的船摇等效方法,消除了地球形状对船摇等效计算的误差,能够准确地计算各测控设备处的船摇数据,对于提高测量船的外测数据处理精度具有重要的意义。
采用上述方法进行实际测试,表1是两种等效船摇方法计算偏差比较结果,可以看出,利用本文提出的方法进行船摇等效,并将测量系数据坐标转换至地心固联系时处理精度更高。
表2是等效船摇方法误差对定轨结果影响结果,可以看出等效船摇误差对初轨半长轴误差影响从64.5米到1512.9米,若进行高精度轨道计算,等效船摇误差不容忽视。
图1至图4是为分析地球形状对船摇等效的影响,本文仿真不同条件下使用平移法和本文的船摇等效方法得到的等效船摇数据差异。上述仿真数据可以看出,等效船摇误差与船位经度、高程几乎无关,与设备视差呈线性关系;在低纬度地区,对纵摇误差影响较大,在高纬度地区,对艏摇误差影响较大;航向为东西向时,对艏摇误差影响较大,航向为南北向时,对艏摇误差影响较小。
除上述实施例外,本发明还包括有其他实施方式,凡采用等同变换或者等效替换方式形成的技术方案,均应落入本发明权利要求的保护范围之内。
Claims (1)
1.一种将测量船惯导船摇数据等效至测控设备处的船摇等效方法,其特征在于:所述方法包括以下步骤:
步骤A、根据惯导测量的船摇数据和惯导三轴交点在地心固联系下的大地坐标(λ,ω,h)以及惯导平台至测控设备间变形欧拉角计算经度旋转矩阵L、纬度旋转矩阵B、船摇旋转矩阵Bc和变形欧拉角矩阵Bb,其中K为艏摇,为纵摇,θ为横摇,λ为经度,ω为纬度,h为高程,
步骤B、根据测控设备三轴中心在惯导甲板系中坐标X0=[x0,y0,z0]T以及经度旋转矩阵L、纬度旋转矩阵B、船摇旋转矩阵Bc计算测控设备三轴中心在地心固联系下直角坐标:
Y1=LBBcX0+Y (5)
其中
e2为参考椭球体第一偏心率的平方,a为地球赤道半径;
步骤C、根据测控设备三轴中心在地心固联系下直角坐标Y1计算其大地坐标计算公式为
步骤D、根据测控设备三轴中心在地心固联系下大地坐标(λ1,ω1,h1)计算设备的经度旋转矩阵L1、纬度旋转矩阵B1,计算公式为
步骤E、计算测控设备等效船摇欧拉角矩阵Bc1,计算公式为:
步骤F、根据测控设备等效船摇欧拉角矩阵Bc1计算测控设备的船摇数据其中设计算公式为
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610392497.5A CN106092100B (zh) | 2016-06-06 | 2016-06-06 | 将测量船惯导船摇数据等效至测控设备处的船摇等效方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610392497.5A CN106092100B (zh) | 2016-06-06 | 2016-06-06 | 将测量船惯导船摇数据等效至测控设备处的船摇等效方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106092100A CN106092100A (zh) | 2016-11-09 |
CN106092100B true CN106092100B (zh) | 2018-12-07 |
Family
ID=57447581
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610392497.5A Expired - Fee Related CN106092100B (zh) | 2016-06-06 | 2016-06-06 | 将测量船惯导船摇数据等效至测控设备处的船摇等效方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106092100B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107505611B (zh) * | 2017-08-09 | 2020-05-19 | 武汉华之洋科技有限公司 | 舰船光电侦察设备视频距离估算实时修正方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102168978A (zh) * | 2010-12-17 | 2011-08-31 | 北京航空航天大学 | 一种船用惯性导航系统摇摆基座开环对准方法 |
CN103322969A (zh) * | 2013-05-30 | 2013-09-25 | 中国科学院长春光学精密机械与物理研究所 | 一种船载无线电测量设备天线变形测量方法 |
CN103727937A (zh) * | 2013-11-20 | 2014-04-16 | 中国人民解放军海军大连舰艇学院 | 一种基于星敏感器的舰船姿态确定方法 |
CN103791903A (zh) * | 2014-02-11 | 2014-05-14 | 哈尔滨工程大学 | 一种针对船舶长航大机动性的星敏感器动态补偿方法 |
CN105300404A (zh) * | 2014-07-09 | 2016-02-03 | 北京自动化控制设备研究所 | 一种舰船基准惯性导航系统标校方法 |
CN105548976A (zh) * | 2015-12-14 | 2016-05-04 | 中国科学院长春光学精密机械与物理研究所 | 船载雷达海上精度鉴定方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60242314A (ja) * | 1984-05-17 | 1985-12-02 | Mitsubishi Heavy Ind Ltd | 赤外線カメラ式船位測定装置 |
US7437246B2 (en) * | 2006-08-01 | 2008-10-14 | Raytheon Company | Method of determining a collision avoidance maneuver |
-
2016
- 2016-06-06 CN CN201610392497.5A patent/CN106092100B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102168978A (zh) * | 2010-12-17 | 2011-08-31 | 北京航空航天大学 | 一种船用惯性导航系统摇摆基座开环对准方法 |
CN103322969A (zh) * | 2013-05-30 | 2013-09-25 | 中国科学院长春光学精密机械与物理研究所 | 一种船载无线电测量设备天线变形测量方法 |
CN103727937A (zh) * | 2013-11-20 | 2014-04-16 | 中国人民解放军海军大连舰艇学院 | 一种基于星敏感器的舰船姿态确定方法 |
CN103791903A (zh) * | 2014-02-11 | 2014-05-14 | 哈尔滨工程大学 | 一种针对船舶长航大机动性的星敏感器动态补偿方法 |
CN105300404A (zh) * | 2014-07-09 | 2016-02-03 | 北京自动化控制设备研究所 | 一种舰船基准惯性导航系统标校方法 |
CN105548976A (zh) * | 2015-12-14 | 2016-05-04 | 中国科学院长春光学精密机械与物理研究所 | 船载雷达海上精度鉴定方法 |
Non-Patent Citations (2)
Title |
---|
"测量船船摇前馈数据处理方法研究及应用";王恒,等;《飞行器测控学报》;20110430;第30卷(第2期);64-69 * |
"航天测量船船摇数据特性分析";李晓勇,等;《中国惯性技术学报》;20060630;第14卷(第3期);27-30,41 * |
Also Published As
Publication number | Publication date |
---|---|
CN106092100A (zh) | 2016-11-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105180968B (zh) | 一种imu/磁强计安装失准角在线滤波标定方法 | |
US10215564B2 (en) | Automatic compass calibration systems and methods | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN110487301A (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
CN110221332A (zh) | 一种车载gnss/ins组合导航的动态杆臂误差估计和补偿方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
CN110501024A (zh) | 一种车载ins/激光雷达组合导航系统的量测误差补偿方法 | |
CN105509769B (zh) | 一种运载火箭捷联惯导全自主对准方法 | |
CN105841698B (zh) | 一种无需调零的auv舵角精确实时测量系统 | |
CN101162147A (zh) | 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法 | |
CN109556631A (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN105928515B (zh) | 一种无人机导航系统 | |
CN106405670A (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法 | |
CN106767925B (zh) | 带双轴转位机构的惯导系统三位置参数辨识对准方法 | |
CN105865490B (zh) | 一种惯性稳定平台固定基座多位置自瞄准方法 | |
CN102706361A (zh) | 一种高精度多惯导系统姿态精度评定方法 | |
CN103439727A (zh) | 一种地面坐标的测量方法 | |
CN106123917B (zh) | 考虑外杆臂效应的捷联惯导系统罗经对准方法 | |
CN105892498A (zh) | 基于三轴云台的目标凝视与扫视控制系统 | |
CN113267794A (zh) | 一种基线长度约束的天线相位中心校正方法及装置 | |
CN108303120A (zh) | 一种机载分布式pos的实时传递对准的方法及装置 | |
CN108151765A (zh) | 一种在线实时估计补偿磁强计误差的定位测姿方法 | |
CN110068325A (zh) | 一种车载ins/视觉组合导航系统的杆臂误差补偿方法 | |
CN207816290U (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20181207 Termination date: 20190606 |
|
CF01 | Termination of patent right due to non-payment of annual fee |