CN107976169B - 一种基于恒星观测的船载惯导姿态角时序检测方法 - Google Patents
一种基于恒星观测的船载惯导姿态角时序检测方法 Download PDFInfo
- Publication number
- CN107976169B CN107976169B CN201711089994.9A CN201711089994A CN107976169B CN 107976169 B CN107976169 B CN 107976169B CN 201711089994 A CN201711089994 A CN 201711089994A CN 107976169 B CN107976169 B CN 107976169B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- theodolite
- angle
- navigation attitude
- data
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
-
- 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/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
-
- 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/165—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 combined with non-inertial navigation instruments
Abstract
本发明涉及一种基于恒星观测的船载惯导姿态角时序检测方法,包括以下步骤:一是利用惯导姿态角和经纬仪测角数据,计算出恒星在地平系下的实测指向。二是使用最小二乘法,拟合计算出任意时刻的惯导姿态角数据。三是计算出超前或滞后不同时间的惯导姿态数据,分别与经纬仪观测数据进行组合,寻找地平系下恒星方位、俯仰角误差的标准差最小的一组惯导姿态数据,对应时序即为惯导姿态角时序误差。本发明具有较高的惯导时序误差检测精度,可以有效提高惯导姿态角测量精度。
Description
技术领域
本发明属于船舶导航技术领域,涉及一种基于恒星观测的船载惯导姿态角时序检测方法,用于船载惯导姿态数据拟合和惯导姿态角时序误差计算。
背景技术
船载惯导设备能够连续输出船体的横纵摇和航向信息,不受天气和电磁环境变化的影响,为很多船载设备的正常工作提供了稳定坐标基准。惯导姿态角测量结果的准确性,除受自身惯性器件性能、系统编排以及导航算法等影响外,还与惯导姿态时序误差有关。在船摇周期10s、船摇幅度5°的情况下,1ms时序误差最大可带来约130″的惯导姿态角测量误差。目前还未有适用于惯导姿态角时序误差稳定情况下的检测方法。
发明内容
本发明所要解决的技术问题是针对上述现有技术提供一种基于恒星观测的船载惯导姿态角时序检测方法,该方法适用于惯导姿态角时序误差稳定情况下的检测计算。
本发明解决上述问题所采用的技术方案为:一种基于恒星观测的船载惯导姿态角时序检测方法,所述方法包括以下步骤:步骤一、利用惯导姿态角和经纬仪测角数据,计算出恒星在地平系下的实测指向;步骤二、使用最小二乘法,拟合计算出任意时刻的惯导姿态角数据;步骤三、计算出超前或滞后不同时间的惯导姿态数据,分别与经纬仪观测数据进行组合,寻找地平系下恒星方位、俯仰角误差的标准差最小的一组惯导姿态数据,对应时序即为惯导姿态角时序误差。
优选地,步骤一具体包括:
1)计算经纬仪甲板系下恒星实测位置
首先,使用脱靶量数据对经纬仪方位和俯仰角进行修正,设恒星在经纬仪视场内方位和俯仰方向的脱靶量分别为△A、△E,则:
式中:Aj、Ej为经纬仪方位和俯仰轴角编码器测量数据;
然后,对经纬仪轴系参数进行修正,
式中:
g—经纬仪方位零位;
c—经纬仪照准差;
I—经纬仪横轴差;
βm—经纬仪垂直轴最大倾斜量;
最后,利用轴系参数修正后的经纬仪测角数据,计算恒星在经纬仪甲板坐标系所在方向单位矢量的直角坐标(xj,yj,zj),
2)计算地平系下恒星实测位置
利用惯导姿态测量数据进行坐标系的旋转和变换,经纬仪甲板系转换到地平系应进行三次坐标旋转,坐标旋转后,在地平系下恒星单位矢量的直角坐标(x,y,z)为:
式中:
R—惯导实测横摇;
P—惯导实测纵摇;
H—惯导实测航向。
根据恒星在地平系下的直角坐标,计算出恒星在地平系下的实测方位、俯仰角:
Edc=atan(z),
式中,Adc为实测方位角,Edc为实测俯仰角。
优选地,步骤二具体包括:
采用最小二乘法完成惯导姿态角基于时间序列的四次多项式拟合,
设短时间的惯导姿态数据用四次多项式进行表示:
式中:
R为横摇,P为纵摇,H为航向,
r0~r4—横摇多项式系数;
p0~p4—纵摇多项式系数;
h0~h4—航向多项式系数。
根据最小二乘法原理,横纵摇和航向多项式系数计算表达式为:
其中:
与现有技术相比,本发明的优点在于:
本发明以空间位置精确已知的恒星作为基准,利用经纬仪观测恒星,采用最小二乘法拟合出基于时间序列的惯导姿态角计算表达式,将不同时序条件下的惯导数据与经纬仪测角数据进行组合,根据恒星在地平系下观测结果的标准差变化趋势和具体数值,分析并确定出惯导姿态角的时序误差。
附图说明
图1为本发明中惯导姿态时序正常情况下的经纬仪方位角误差示意图。
图2为本发明中惯导姿态滞后10ms引起的经纬仪方位角误差示意图。
具体实施方式
以下结合附图实施例对本发明作进一步详细描述。
本发明提供一种基于恒星观测的船载惯导姿态角时序检测方法,主要内容涉及恒星在地平系下实测位置计算、惯导姿态数据拟合和惯导姿态角时序误差计算。
一、相关说明
为便于本发明内容描述,在此对发明中涉及的坐标系定义简要说明。
本发明主要涉及如下二个坐标系:
二、恒星在地平系下实测位置计算
1.经纬仪甲板系下恒星实测位置计算
首先,使用脱靶量数据对经纬仪方位和俯仰角进行修正。设恒星在经纬仪视场内方位和俯仰方向的脱靶量分别为△A、△E,则:
式中:Aj、Ej为经纬仪方位和俯仰轴角编码器测量数据。
然后,对经纬仪轴系参数进行修正。
式中:
g—经纬仪方位零位;
c—经纬仪照准差;
I—经纬仪横轴差;
βm—经纬仪垂直轴最大倾斜量。
最后,利用轴系参数修正后的经纬仪测角数据,计算恒星在经纬仪甲板坐标系所在方向单位矢量的直角坐标(xj,yj,zj)。
2.地平系下恒星实测位置计算
利用惯导姿态测量数据进行坐标系的旋转和变换,经纬仪甲板系转换到地平系应进行三次坐标旋转,坐标旋转后,在地平系下恒星单位矢量的直角坐标(x,y,z)为:
式中:
R—惯导实测横摇;
P—惯导实测纵摇;
H—惯导实测航向。
根据恒星在地平系下的直角坐标,计算出恒星在地平系下的实测方位、俯仰角:
Edc=atan(z)
三、惯导姿态数据拟合
由于船舶惯性较大,其横纵摇和航向的变化曲线较为平滑,可采用最小二乘法完成惯导姿态角基于时间序列的四次多项式拟合。
设短时间的惯导姿态数据可以用四次多项式进行表示:
式中:
r0~r4—横摇多项式系数;
p0~p4—纵摇多项式系数;
h0~h4—航向多项式系数。
根据最小二乘法原理,横纵摇和航向多项式系数计算表达式为:
其中:
四、惯导姿态角时序误差计算
1.惯导姿态角时序误差特点
与恒星在地平系下的理论方位、俯仰相比,恒星实测方位、俯仰角的误差为下面三种误差的叠加。
(1)惯导姿态角常值性误差,由于短时间内恒星在地平系下的位置变化较小,引起的恒星实测方位、俯仰误差可视为常值。
(2)惯导姿态角随机性误差,引起的恒星实测方位、俯仰误差可视为随机性误差。
(3)经纬仪轴系参数常值性误差,引起的恒星实测方位、俯仰误差可视为常值。
当惯导姿态角时序正常时,恒星实测方位、俯仰角误差特点应为围绕常值误差的随机分布,惯导姿态角时序正常情况下的恒星实测方位角误差,如图1所示。
当惯导姿态角时序存在稳定误差时,惯导姿态角误差将呈现出类似正弦的变化。该误差引起的恒星实测方位、俯仰误差特点,应为围绕常值误差变化的类似正弦叠加曲线,如图2所示。
2.惯导姿态角时序误差检测方法
使用最小二乘拟合算法,计算出在现有时序下超前或滞后不同时间时的惯导姿态数据,使其分别与经纬仪观测数据进行组合,计算出在地平系下恒星方位、俯仰角误差的标准差。
恒星实测方位、俯仰角误差的标准差会随着惯导姿态角时序误差的增大而变大,标准差最小的那组惯导姿态数据对应的时序,即为惯导姿态角时序误差。
实施例:
经纬仪在观测同一颗恒星的过程中,不断调整惯导时统修正量,修正量的步进幅度为1ms,获取了数组惯导和经纬仪实测数据,并对各组数据对应的实测恒星方位角误差的标准差进行计算,具体结果如表1所示。
表1惯导时序误差与经纬仪方位标准差关系表
表1中,惯导姿态角时序误差越大,经纬仪方位误差标准差也越大。
除上述实施例外,本发明还包括有其他实施方式,凡采用等同变换或者等效替换方式形成的技术方案,均应落入本发明权利要求的保护范围之内。
Claims (3)
1.一种基于恒星观测的船载惯导姿态角时序检测方法,其特征在于:所述方法包括以下步骤:步骤一、利用惯导姿态角和经纬仪测角数据,计算出恒星在地平系下的实测指向;步骤二、使用最小二乘法,拟合计算出任意时刻的惯导姿态角数据;步骤三、计算出超前或滞后不同时间的惯导姿态数据,分别与经纬仪观测数据进行组合,寻找地平系下恒星方位、俯仰角误差的标准差最小的一组惯导姿态数据,对应时序即为惯导姿态角时序误差。
2.根据权利要求1所述的一种基于恒星观测的船载惯导姿态角时序检测方法,其特征在于:步骤一具体包括:
1)计算经纬仪甲板系下恒星实测位置
首先,使用脱靶量数据对经纬仪方位和俯仰角进行修正,设恒星在经纬仪视场内方位和俯仰方向的脱靶量分别为ΔA、ΔE,则:
式中:Aj、Ej为经纬仪方位和俯仰轴角编码器测量数据;
然后,对经纬仪轴系参数进行修正,
式中:
g—经纬仪方位零位;
c—经纬仪照准差;
I—经纬仪横轴差;
βm—经纬仪垂直轴最大倾斜量;
h—俯仰方位零位;
Am—方位转盘出现最大倾斜角度对应的方位角;
最后,利用轴系参数修正后的经纬仪测角数据,计算恒星在经纬仪甲板坐标系所在方向单位矢量的直角坐标(xj,yj,zj),
2)计算地平系下恒星实测位置
利用惯导姿态测量数据进行坐标系的旋转和变换,经纬仪甲板系转换到地平系应进行三次坐标旋转,坐标旋转后,在地平系下恒星单位矢量的直角坐标(x,y,z)为:
式中:
R—惯导实测横摇;
P—惯导实测纵摇;
H—惯导实测航向。
根据恒星在地平系下的直角坐标,计算出恒星在地平系下的实测方位、俯仰角:
Edc=a tan(z),
式中,Adc为实测方位角,Edc为实测俯仰角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711089994.9A CN107976169B (zh) | 2017-11-08 | 2017-11-08 | 一种基于恒星观测的船载惯导姿态角时序检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711089994.9A CN107976169B (zh) | 2017-11-08 | 2017-11-08 | 一种基于恒星观测的船载惯导姿态角时序检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107976169A CN107976169A (zh) | 2018-05-01 |
CN107976169B true CN107976169B (zh) | 2020-05-22 |
Family
ID=62013100
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711089994.9A Expired - Fee Related CN107976169B (zh) | 2017-11-08 | 2017-11-08 | 一种基于恒星观测的船载惯导姿态角时序检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107976169B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111044047B (zh) * | 2019-12-18 | 2021-08-20 | 北京电子工程总体研究所 | 一种基于分式逼近的方向角航迹预测方法 |
CN111880209B (zh) * | 2020-07-21 | 2022-09-06 | 山东省科学院海洋仪器仪表研究所 | 一种船体姿态计算方法及应用 |
CN112346485B (zh) * | 2020-12-24 | 2021-05-25 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种光电跟踪控制方法、系统、电子设备及存储介质 |
CN117191087B (zh) * | 2023-11-08 | 2024-01-23 | 中国科学院长春光学精密机械与物理研究所 | 船载光电经纬仪与惯导坞外轴系的取齐方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101893440B (zh) * | 2010-05-19 | 2011-12-14 | 哈尔滨工业大学 | 基于星敏感器的天文自主导航方法 |
CN102706361B (zh) * | 2012-05-18 | 2015-09-09 | 中国人民解放军92537部队 | 一种高精度多惯导系统姿态精度评定方法 |
CN103913180A (zh) * | 2014-03-26 | 2014-07-09 | 中国科学院长春光学精密机械与物理研究所 | 一种船载大视场高精度星敏感器的安装角标定方法 |
CN105371844B (zh) * | 2015-12-02 | 2018-02-16 | 南京航空航天大学 | 一种基于惯性/天文互助的惯性导航系统初始化方法 |
CN105737858B (zh) * | 2016-05-04 | 2018-06-08 | 北京航空航天大学 | 一种机载惯导系统姿态参数校准方法与装置 |
-
2017
- 2017-11-08 CN CN201711089994.9A patent/CN107976169B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN107976169A (zh) | 2018-05-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107976169B (zh) | 一种基于恒星观测的船载惯导姿态角时序检测方法 | |
WO2005059584A1 (en) | Method of determining azimuth and elevation angles using a single axis direction finding system | |
CN105509765B (zh) | 一种惯性/dvl/usbl安装误差标定方法 | |
CN105812791B (zh) | 一种光学跟踪测量数据系统误差补偿方法 | |
CN101169323A (zh) | 在室内用旋转靶标测量电视经纬仪动态测角精度的方法 | |
CN104459728B (zh) | 一种基于gnss定位的磁偏角校准方法 | |
CN107179533A (zh) | 一种多参数机载LiDAR系统误差自动检校方法 | |
CN106546262A (zh) | 基于平面控制和约束结合的移动测量系统外参数标定方法 | |
CN109856640B (zh) | 一种基于反光柱或反光板的单线激光雷达二维定位方法 | |
CN103134387A (zh) | 一种低空慢速小目标探测与拦截系统标定方法 | |
CN104535042B (zh) | 基于非正交轴系激光经纬仪的测量方法 | |
CN103913179A (zh) | 舰载单轴旋转调制捷联惯导姿态角修正方法 | |
CN102207380A (zh) | 一种高精度横轴倾斜误差补偿方法 | |
CN110275139B (zh) | 一种基于旋转式基元复用的超短基线定位系统及方法 | |
CN116126034A (zh) | 一种船载测控天线光电标校方法 | |
CN110082033B (zh) | 一种运动状态下的水上载体重心测量装置和方法 | |
CN107621254A (zh) | 一种身管轴线指向测试方法 | |
CN115326007A (zh) | 一种基于恒星观测的船载经纬仪测角时序检测方法 | |
CN103759922A (zh) | 一种航天遥感器二维指向镜指向精度测量方法 | |
CN102155956B (zh) | 一种高精度垂直角横轴倾斜误差补偿方法 | |
CN111721282B (zh) | 一种基于天文导航原理的捷联惯导坐标系动态取齐方法 | |
CN108917789B (zh) | 一种基于俯仰轴和横滚轴相对夹角的倾角仪正交性评估方法 | |
CN105403144B (zh) | 一种用于飞机自动化装配的iGPS动态测量误差实时补偿方法 | |
CN104330078B (zh) | 一种基于三点后方交会模型的联合测量方法 | |
CN111693051A (zh) | 一种基于光电传感器的多目标数据关联方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200522 Termination date: 20211108 |