CN108489483B - 一种船载星光定向仪单星次优修正算法 - Google Patents
一种船载星光定向仪单星次优修正算法 Download PDFInfo
- Publication number
- CN108489483B CN108489483B CN201810168111.1A CN201810168111A CN108489483B CN 108489483 B CN108489483 B CN 108489483B CN 201810168111 A CN201810168111 A CN 201810168111A CN 108489483 B CN108489483 B CN 108489483B
- Authority
- CN
- China
- Prior art keywords
- star
- coordinate system
- ship
- vector
- latitude
- 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.)
- Active
Links
- 238000012937 correction Methods 0.000 title claims abstract description 31
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 24
- 238000005259 measurement Methods 0.000 claims abstract description 23
- 238000000034 method Methods 0.000 claims abstract description 12
- 239000013598 vector Substances 0.000 claims description 24
- 238000006243 chemical reaction Methods 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000003384 imaging method Methods 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 abstract description 7
- 238000013178 mathematical model Methods 0.000 abstract 2
- 238000010586 diagram Methods 0.000 description 4
- 230000035945 sensitivity Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 229910002056 binary alloy Inorganic materials 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
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/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
-
- 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
- G01C21/025—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Navigation (AREA)
Abstract
本发明为一种船载星光定向仪单星次优修正算法,适用于航海船载用惯性测量组合在单颗恒星条件下利用星光定向仪修正船的地理经纬度位置。该算法基于单星在地心地理坐标系和当地地理坐标系下的天顶角等同关系,利用球面三角和拉格朗日极值条件建立了单星修正的数学模型,该数学模型为两元互耦合的方程组。本算法在求解方程组时进行了化简,求解获得修正后船的地理经纬度。本发明方法使星光定向仪在单星观测条件下可以对船载的地理经纬度进行次优精度的实时修正,降低了船载星光定向仪对观测星数量的约束,具有工程应用价值。本发明利用拉格朗日方程得到了解析形式的次优解,计算速度快,修正的实时性好。
Description
技术领域
本发明属于组合天文导航中星光定向仪对惯性测量组合的修正算法领域,涉及一种船载星光定向仪单星次优修正算法。
背景技术
船载的惯性测量组合由于自身存在漂移,造成长期使用过程中误差逐渐累积放大,因此需要引入校正。
星光定向仪在全天候条件下,在海上对星空背景成像来进行定位。当视场内只有单颗星时,星光定向仪无法对惯性测量组合给出修正信息。由于白昼观星图像中强背景辐射灰度对灵敏度和视场的限制关系,此种情况单星出现的概率远大于两颗星和多颗星。
同时由于图像芯片灵敏度所限,导致白昼条件下提取的观测星个数较少,导致出现单星的概率进一步增大。
如何实现船载星光定向仪在单星观测条件下对惯性测量组合的实时修正,是本领域亟待解决的技术问题。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提出了一种组合天文导航中星光定向仪对惯性测量组合的修正算法,解决了目前白昼观星和图像芯片灵敏度受限的条件下星光定向仪对惯性测量组合的次优修正问题,对实际工程中船载星光定向仪针对惯性测量组合的修正具有应用价值。
本发明的技术方案是:
提供一种船载星光定向仪单星次优修正算法,步骤如下:
(2)当单颗星与星光定向仪导航星表内的导航星完成匹配,根据导航星表查询该颗星在地心赤道惯性坐标系下的矢量Vi,将矢量Vi转换到地心地理坐标系获得矢量Ve=[xEyE zE]T,由矢量Ve计算在地心地理坐标系下单颗星在单位地球表面的投影位置
z=arccos(zg)
zg为当地地理坐标系下的矢量Vg沿垂线方向的分量。
优选的,zg的获取方法如下:
单颗星在星光定向仪像面坐标系的位置(u,v)和焦距f,该位置对应的矢量Vs,根据针孔成像模型,在测量坐标系有
矢量Vs转换到当地地理坐标系下,获得矢量Vg
星光定向仪基准镜坐标系转换到测量坐标系的转换矩阵为Cmj;θ为俯仰角,为滚动角,ψ为偏航角,R1(θ)、R3(ψ)分别表示绕当地地理坐标系E、N、U轴旋转的方向余弦矩阵,E轴指向正东,N轴指向正北,U轴沿垂线方向指向天。
优选的,步骤(4)中求解获得修正后船的地理经度λB的具体方法如下:
本发明与现有技术相比的有益成果是:
(1)本发明方法使星光定向仪在单星观测条件下可以对船载的地理经纬度进行次优精度的实时修正,降低了船载星光定向仪对观测星数量的约束,具有工程应用价值。
(2)本发明利用地心地理坐标系和当地地理坐标系两个中间坐标系实现了星光定向仪基准镜坐标系到地心赤道惯性坐标系的转换,基于该转换方式实现了利用单颗星进行惯性测量组合地理经纬度的修正。
(3)本发明利用拉格朗日方程得到了解析形式的次优解,计算速度快,修正的实时性好。
附图说明
图1为本发明的星光定向仪工作原理图;
图2为单星修正次优算法示意图;
图3为船载星光定向仪坐标系转换关系图。
具体实施方式
本发明方法所涉及的星光定向仪的工作原理图如图1所示。
本发明中,星光定向仪每一帧接收惯性测量组合输出的地心地理坐标系数据:地理经纬度水平方位角(俯仰角θ和滚动角),偏航角ψ和UTC时间以及惯性系下的粗指向。待修正的量为地理经纬度和偏航角ψ。星光定向仪在进行恒星成像时可能观测到1颗或者≥2颗观测星,分别用本发明的次优修正算法和多星修正算法(两颗星可以计算姿态数据从而直接求解航向角和地理经纬度,不属于本发明内容)。
船载修正算法主要涉及如下几种坐标系,分别定义如下:
地心赤道惯性坐标系Ci─赤道惯性坐标系又称地心天球参考系(GCRS),为近地空间坐标系。GCRS以地心为原点,xi轴指向春分点,zi轴指向北天极,yi轴由右手定则确定。
地心地理坐标系Ce─地心地理坐标系与地球固联,也称国际地球参考系(ITRS)。其坐标原点在地心,xe轴指向经纬度为零的点,ze轴指向地北极,ye轴由右手定则确定。位置的测量通常以ITRS为基准。
当地地理坐标系Cg─当地地理坐标系是用来表示载***置的坐标系,是水平和航向的基准,也称东北天地平坐标系(ENU)。其原点为载体重心,E轴指向正东,N轴指向正北,U轴沿垂线方向指向天。
星光定向仪基准镜坐标系CJ─该坐标系与对应测量坐标系仅存在一个旋转矩阵,目前算法实验时假定等同于载体坐标系和测量系。恒星在像面的位置(u,v)坐标转换成单位矢量在该坐标系下表示,标定系数在该坐标系下表示。计算的姿态指该坐标系下惯性指向的方向余弦矩阵。
上述4种坐标系相互转换关系如图3所示。
已知单颗星在星光定向仪像面坐标系的位置(u,v)和焦距f,该位置对应的矢量Vs,根据针孔成像模型,在测量坐标系有
已知测量系与星光定向仪基准镜坐标系的关系Cmj由标定试验给出,满足矢量Vs=CmjVj,Vj为转换至星光定向仪基准镜坐标系下的矢量。
当地地理坐标系与地心地理坐标系满足的关系如下:
由此实现了上述4种坐标系之间的相互转换,可用于后续修正算法进行计算。由于单颗星无法直接计算星光定向仪基准镜坐标系在地心赤道惯性坐标系下的姿态矩阵,本发明利用地心地理坐标系和当地地理坐标系两个中间坐标系实现了转换。
当单颗星与星光定向仪导航星表内的导航星完成匹配,则根据导航星表能够查询到Vi,从而Ve=[xE yE zE]T可求,从而有:
z=arccos(zg)
针对上面的拉格朗日函数求偏导,消去λ,整理得到二元相互耦合的方程组;对偏导方程组进行简化:λB-λ0=dx,其中dx为无穷小量;首先需计算得到一个初解y0,满足其中dy为无穷小量。利用无穷小量x满足sinx≈x,cosx≈1关系并约减小量的二次项,最终得到
上式中,x=λB。船载星光定向仪单星次优算法计算完毕。
一种船载星光定向仪单星次优修正算法,步骤如下:
2)当单颗星与星光定向仪导航星表内的导航星完成匹配,则根据导航星表能够查询到Vi,Vi=CieVe,从而Ve=[xE yE zE]T,计算在地心地理坐标系下单颗星在单位地球表面的投影位置 C(UTC)表示Cie为UTC时间、地理经纬度的函数,其获取方式为现有技术;
4)对拉格朗日函数求偏导,消去λ,整理得到二元相互耦合的方程组;根据先验知识λB-λ0=dx,其中dx为无穷小量,利用无穷小量与正余弦的近似关系,将方程组的其中一个方程进行化简,计算得到一个初解y0满足 其中dy为无穷小量;
本发明的次优算法结果与最优解的误差在十几个角秒量级。本发明降低了船载星光定向仪修正算法对观测星数量的约束,可以在单星条件中对船载惯导误差进行实时修正,填补了理论空白并已完成工程应用。
以上所述,仅为本发明最佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明未具体说明部分属于本领域公知技术。
Claims (4)
1.一种船载星光定向仪单星次优修正算法,其特征在于,步骤如下:
(2)当单颗星与星光定向仪导航星表内的导航星完成匹配,根据导航星表查询该颗星在地心赤道惯性坐标系下的矢量Vi,将矢量Vi转换到地心地理坐标系获得矢量Ve=[xE yEzE]T,由矢量Ve计算在地心地理坐标系下单颗星在单位地球表面的投影位置(λA,);
z=arccos(zg)
zg为当地地理坐标系下的矢量Vg沿垂线方向的分量;
zg的获取方法如下:
单颗星在星光定向仪像面坐标系的位置(u,v)和焦距f,该位置对应的矢量Vs,根据针孔成像模型,在测量坐标系有
矢量Vs转换到当地地理坐标系下,获得矢量Vg
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810168111.1A CN108489483B (zh) | 2018-02-28 | 2018-02-28 | 一种船载星光定向仪单星次优修正算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810168111.1A CN108489483B (zh) | 2018-02-28 | 2018-02-28 | 一种船载星光定向仪单星次优修正算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108489483A CN108489483A (zh) | 2018-09-04 |
CN108489483B true CN108489483B (zh) | 2020-06-09 |
Family
ID=63341265
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810168111.1A Active CN108489483B (zh) | 2018-02-28 | 2018-02-28 | 一种船载星光定向仪单星次优修正算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108489483B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109470275B (zh) * | 2018-12-17 | 2022-06-28 | 中国科学院光电技术研究所 | 一种机动布站的光电经纬仪高精度自主定向方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101893440A (zh) * | 2010-05-19 | 2010-11-24 | 哈尔滨工业大学 | 基于星敏感器的天文自主导航方法 |
WO2014186081A1 (en) * | 2013-05-14 | 2014-11-20 | The Charles Stark Draper Laboratory, Inc. | Star tracker with steerable field-of-view baffle coupled to wide field-of-view camera |
CN105486314A (zh) * | 2015-11-24 | 2016-04-13 | 南京航空航天大学 | 对月球空间无缝覆盖的拉格朗日导航星座及其构建方法 |
CN106568462A (zh) * | 2016-10-28 | 2017-04-19 | 北京控制工程研究所 | 一种多探头星敏感器融合姿态测试方法 |
-
2018
- 2018-02-28 CN CN201810168111.1A patent/CN108489483B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101893440A (zh) * | 2010-05-19 | 2010-11-24 | 哈尔滨工业大学 | 基于星敏感器的天文自主导航方法 |
WO2014186081A1 (en) * | 2013-05-14 | 2014-11-20 | The Charles Stark Draper Laboratory, Inc. | Star tracker with steerable field-of-view baffle coupled to wide field-of-view camera |
CN105486314A (zh) * | 2015-11-24 | 2016-04-13 | 南京航空航天大学 | 对月球空间无缝覆盖的拉格朗日导航星座及其构建方法 |
CN106568462A (zh) * | 2016-10-28 | 2017-04-19 | 北京控制工程研究所 | 一种多探头星敏感器融合姿态测试方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108489483A (zh) | 2018-09-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106124170B (zh) | 一种基于高精度姿态信息的相机光轴指向计算方法 | |
CN106871927B (zh) | 一种无人机光电吊舱安装误差标校方法 | |
CN104764443B (zh) | 一种光学遥感卫星严密成像几何模型构建方法 | |
CN105698762A (zh) | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 | |
CN107450582B (zh) | 一种基于星上实时规划的相控阵数传引导控制方法 | |
CN101414003B (zh) | 一种基于星地坐标转换的星载sar图像地理编码方法 | |
CN105548976A (zh) | 船载雷达海上精度鉴定方法 | |
CN101750067B (zh) | 一种成像式地球敏感器地球扁率修正方法 | |
CN105387874A (zh) | 船载高精度星敏感器安装角标定方法 | |
CN111307139A (zh) | 一种基于偏振/天文信息融合的航向与姿态确定方法 | |
CN108828623B (zh) | 静止气象卫星成像仪的地球固定网格映射方法 | |
CN107490364A (zh) | 一种大角度倾斜成像航空相机对地目标定位方法 | |
CN110631567B (zh) | 一种差分天空偏振罗盘大气折射误差的反演及修正方法 | |
CN107525492B (zh) | 一种适用于敏捷对地观测卫星的偏流角仿真分析方法 | |
CN105004354A (zh) | 大斜视角下无人机可见光和红外图像目标定位方法 | |
CN110542407A (zh) | 一种航拍图像任意像素点定位信息获取方法 | |
CN102279001B (zh) | 一种星载相机的相移补偿方法 | |
CN112713922A (zh) | 一种多波束通讯卫星的可见性快速预报算法 | |
CN114137590B (zh) | 一种基于正交轴系调平装置北向基准修正的目标定位方法 | |
CN106289156B (zh) | 一种卫星以任意姿态成像时获取摄影点太阳高度角的方法 | |
CN111879299B (zh) | 一种地基望远镜全自动指星方法 | |
CN108489483B (zh) | 一种船载星光定向仪单星次优修正算法 | |
CN107883925B (zh) | 一种导航星座星间观测目标卫星图像模拟方法 | |
CN112833878A (zh) | 近地面多源天文自主导航方法 | |
CN111879298B (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 |