CN111947652A - 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 - Google Patents
一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 Download PDFInfo
- Publication number
- CN111947652A CN111947652A CN202010810080.2A CN202010810080A CN111947652A CN 111947652 A CN111947652 A CN 111947652A CN 202010810080 A CN202010810080 A CN 202010810080A CN 111947652 A CN111947652 A CN 111947652A
- Authority
- CN
- China
- Prior art keywords
- inertial
- error
- lander
- coordinate system
- attitude
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000005259 measurement Methods 0.000 claims abstract description 81
- PEDCQBHIVMGVHV-UHFFFAOYSA-N Glycerine Chemical compound OCC(O)CO PEDCQBHIVMGVHV-UHFFFAOYSA-N 0.000 claims abstract description 64
- 230000000007 visual effect Effects 0.000 claims abstract description 56
- 239000013598 vector Substances 0.000 claims abstract description 53
- 238000001914 filtration Methods 0.000 claims abstract description 12
- 239000011159 matrix material Substances 0.000 claims description 69
- 230000009466 transformation Effects 0.000 claims description 23
- 230000008569 process Effects 0.000 claims description 8
- 238000012546 transfer Methods 0.000 claims description 6
- 238000007781 pre-processing Methods 0.000 claims description 4
- 238000009434 installation Methods 0.000 claims description 3
- 238000003909 pattern recognition Methods 0.000 claims description 3
- 239000000523 sample Substances 0.000 abstract description 4
- 230000006870 function Effects 0.000 description 14
- 238000010586 diagram Methods 0.000 description 7
- 230000008901 benefit Effects 0.000 description 4
- 238000005070 sampling Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000000605 extraction Methods 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 241000282414 Homo sapiens Species 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 241001061260 Emmelichthys struhsakeri Species 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Astronomy & Astrophysics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法。首先根据月球固连坐标系下惯性导航的力学编排,以惯性导航误差方程作为状态模型,再分别利用惯性/视觉导航***获得的相对位置和姿态误差,利用天文导航***获得的星光矢量,利用激光测距仪获得的距离作为量测量。之后根据这些量测量分别建立惯性/视觉导航***相对位置和姿态误差、星光矢量及激光测距的量测模型。最后使用UKF滤波估计着陆器的位置、速度和姿态,对月球着陆器的姿态误差和惯性器件误差进行修正。本发明属于深空探测器自主导航领域,可为月球着陆器提供高精度的位置、速度及姿态信息,对深空探测具有重要的实际意义。
Description
技术领域
本发明属于深空探测器自主导航领域,涉及一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法。
背景技术
深空探测技术作为人类航天活动的重要方向和空间科学与技术创新的重要途径,是国家综合国力的重要标志,是当前和未来航天领域的发展重点之一,对科技提升、经济与社会发展起着重要作用。近年来我国深空探测技术迅速发展,深空探测能力不断提升,月球探测已渐入佳境。以嫦娥四号为例,其着陆器于2018年12月8日发射入轨,2019年1月3日10时26分成功软着陆于月球背面,实现了人类首次月球背面软着陆。
对于月球探测任务而言,导航精度对于任务的成败有着重要影响,国内外采取多种手段致力于提高着陆器导航精度。据张洪华等人研究,我国嫦娥三号月球探测器在软着陆过程中采用IMU、激光测距仪和微波测距测速敏感器组合的导航方式,可以通过激光和微波测距信息融合来修正惯导高度误差,通过微波测速多波束组合来修正速度误差,但是姿态误差有待校正。欧空局月球着陆器采用了IMU、距离传感器和导航相机相组合的导航方法,依然无法准确估计姿态信息。本发明提出的一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,在传统的惯性/视觉导航基础上,辅助天文与激光测距导航,能够更准确的修正位置与姿态信息。在月球探测的软着陆阶段,主要采用惯性/视觉组合导航获取信息。惯性导航根据初始轨道的装订数据,对惯性测量单元的输出进行积分,得到着陆器的位置、速度和姿态,视觉导航通过对外界环境的感知来确定着陆器的位置和姿态的变化,并通过整合得到当前的位置和姿态。但是,由于惯性测量单元中的陀螺和加速度计不可避免的存在误差,并随时间累积,视觉导航随周围环境变化产生误差,并随距离累积,这些都会严重影响导航精度。因此,常添加其他导航辅助组合导航来改善导航性能。常见的导航有天文导航与激光测距导航等,天文导航误差与时间和距离无关,可修正导航姿态信息,但定位精度不高,可利用激光测距提高导航精度,较好地修正着陆器的位置信息。因此,惯性导航、视觉导航、天文导航和激光测距具有很好的优势互补特性,对于长时间、长距离的着陆器自主导航任务,利用激光测距与天文导航辅助惯性/视觉导航实现月面巡视着陆器的自主导航是一种可行的方法。
发明内容
本发明要解决的技术问题是:克服单独使用某种导航方法存在的缺点,为月球着陆器提供一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,大大提供高精度的位置、速度和姿态信息。
本发明解决其技术问题所采用的技术方案为:一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,实现为:
第一步,在月球固连坐标系下,建立基于惯性导航误差方程的月球着陆器的状态模型;
第二步,再分别利用惯性/视觉导航***获得惯性/视觉导航***的相对位置和姿态误差,利用天文导航***获得恒星的星光矢量,利用激光测距仪获得月球着陆器相对月面的距离作为量测量;
第三步,根据所述量测量分别建立惯性/视觉导航***相对位置和姿态误差量测模型、星光矢量量测模型及激光测距的量测模型;
第四步,基于第一步中的状态模型和第三步中的量测模型,采用UKF滤波估计月球着陆器的位置、速度和姿态,对月球着陆器的姿态误差和惯性器件误差进行修正。
具体包括以下步骤:
1、建立基于惯性导航误差方程的***状态模型
以月球固连坐标系下惯性导航的误差方程作为***状态模型:
其中φ=[φE φN φU]T是姿态误差角,φE、φN、φU分别表示惯性导航***地理坐标系,即n系内东、北、天向的姿态误差;fn是n系下的比力矢量;是月球着陆器速度误差,δE、δN、δU分别表示惯性导航***东、北、天向的速度误差;δrn=[δL δλ δh]T是月球着陆器位置误差,δL、δλ、δh分别表示惯性导航***纬度误差、经度误差及高度误差;是月球着陆器在n系下的月球角速率,是的误差;是n系相对m系的旋转角速率在n系中的表示,是的误差,Rm为月球参考半径;是n系相对i系的转动角速度,ε=(εx εyεz)T是惯性导航***x、y、z三个方向的陀螺仪常值漂移,是惯性导航***x、y、z三个方向加速度计的常值偏置;所述m系是月球固连坐标系,i系为惯性坐标系;
上式状态模型(1)写为:
Xk=F(Xk-1,k-1)+Wk-1 (2)
其中状态量为分别为月球着陆器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,Xk,Xk-1分别为k时刻和k-1下的状态量,F(Xk-1,k-1)为惯性/视觉/天文/激光测距组合导航***非线性转移函数,Wk-1为过程噪声。
2、建立惯性/视觉导航***相对位置和姿态误差量测模型
惯性导航***(INS)根据陀螺仪和加速度计惯性传感器来测量线性加速度和角速率,并对测量值进行积分得到位置、速度和姿态信息,视觉导航***(VNS)通过对外界环境的感知来确定着陆器的位置和姿态变化,整合得到当前的位置和姿态,由于有些测量值是用不同的坐标系表示的,需要进行一些计算和变换,根据惯性/视觉导航***获得相对位置和姿态误差,将其作为量测量并建立量测模型:
通过INS获得相对旋转矩阵RINS,位置矢量TINS,表示为:
其中,表示惯性导航***下真实姿态矩阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,rINS(k)表示tk时刻惯性导航***下月球着陆器在月球固连坐标系下的观测位置矢量,表示tk-1时刻月球着陆器在地理坐标系中的姿态矩阵估计值,表示tk-1时刻月球着陆器的位置矢量估计值,姿态矩阵和位置rINS(k)表示为:
校正后tk-1时刻的估计误差满足:
则RINS与TINS最终表示为:
其中,Rerr是的估计误差,定义为 为tk时刻月球着陆器在地理坐标系中的真实姿态矩阵,表示tk-1时刻月球着陆器在地理坐标系中的真实姿态矩阵,r(k)是tk时刻月球着陆器在月球固连坐标系下的真实位置,r(k-1)是tk-1时刻月球着陆器在月球固连坐标系下的真实位置,δr(k)=rINS(k)-r(k)是rINS(k)的估计误差;
通过VNS获得相对旋转矩阵RVNS,位置矢量TVNS,表示为:
其中,△RVNS和△TVNS表示RVNS和TVNS的误差;
则INS和VNS之间的姿态误差表示为g(RINS·RT VNS):
g(RINS·RT VNS)=g(Rerr·△RVNS)≈g(Rerr)+g(△RVNS) (7)
当姿态误差角φ非常小时,将φ表示为Rerr的函数:
φ=g(Rerr) (8)
g(RINS·RT VNS)=g(Rerr·△RVNS)≈g(Rerr)+g(△RVNS)=φ+△φ (9)
INS和VNS之间的位置矢量误差表示为:
其中,rn,INS(k)=[LINS(k),λINS(k),hINS(k)]T是tk时刻惯性导航***下月球着陆器在地理坐标系下的位置矢量,位置误差δrn(k)=[△L(k),△λ(k),△h(k)]T,表示tk时刻惯性导航***下月球着陆器在月球固连坐标系下的观测姿态矩阵,表示tk时刻月球着陆器在月球固连坐标系下的真实姿态矩阵,是rn,INS(k)和δrn(k)的函数,表示为:
λ(k)=λINS(k)+△λ(k)
L(k)=LINS(k)+△L(k) (12)
h(k)=hINS(k)+△h(k)
式中,λINS(k)、LINS(k)及hINS(k)是tk时刻惯性导航***下月球着陆器所获得的经度、纬度和高度;△L(k)、△λ(k)及△h(k)是经度误差、纬度误差和高度误差。
把惯性/视觉导航***相对位置和姿态误差作为量测量Z1,建立相对位置和姿态误差量测模型的表达式:
其中g(·)是将姿态矩阵转换为欧拉角的函数,h1(·)表示非线性量测函数,V1=[△φ,△TVNS]是量测噪声矩阵。
3、建立星光矢量量测模型
当月球着陆器下降时,天文导航***通过观测天体提供姿态信息,天文导航***由星传感器和星图像处理软件组成,星敏感器捕获原始星图,预处理后,通过对星图的质心提取,得到星图的二维像素坐标,进而在星敏感器坐标系中表示出恒星星光方向矢量ss为:
其中,si=[xi,yi,zi]T=[cos△cosRA,cos△sinRA,sin△]T,是通过星象模式识别得到的惯性坐标系下的星光矢量,△,RA分别为天体的赤纬和赤经,是星敏感器的安装矩阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,Rerr是的估计误差,是从n坐标系到b坐标系的变换矩阵,是从m坐标系到n坐标系的变换矩阵,是从i坐标系到m坐标系的变换矩阵。
以星光矢量作为量测量Z2,建立星光矢量量测模型的表达式:
Z2=[sS]=h2(X)+V2 (15)
其中h2(·)表示星光矢量的非线性量测函数,V2表示星敏感器的量测噪声。
4、建立距离量测模型
利用激光测距仪获得月球着陆器相对月面的斜距,并以此作为量测量:
其中,kl为测距敏感器标度因数,Rm为月球参考半径,hm()为月球数字高程库,b为测距敏感器常值偏差,为本体系到月心惯性系的方向余弦阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,Rerr是的估计误差,是从n坐标系到b坐标系的变换矩阵,是从m坐标系到n坐标系的变换矩阵,是从i坐标系到m坐标系的变换矩阵,A1为激光测距波束在本体系指向,v3为测距敏感器测量噪声;
则基于距离的量测模型为:
Z3=[l]=h3(X)+V3 (17)
其中,h3(·)表示距离量测量的非线性量测函数,V3表示量测噪声。
5、进行UKF滤波获得着陆器的位置、速度及姿态估计
设惯性/视觉/天文/激光测距组合导航***的量测量Z=[Z1,Z2,Z3]T,量测噪声V=[V1,V2,V3]T,建立惯性/视觉/天文/激光测距组合导航***量测模型
由此得惯性/视觉/天文/激光测距组合导航***的状态模型与量测模型:
其中,F(Xk-1,k-1)为组合导航***非线性转移函数,H(Xk,k)为非线性量测函数,Wk-1及Vk分别表示过程与量测噪声,对式(19)通过UKF滤波获得月球着陆器的后验状态估计分别为月球着陆器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,以及后验误差协方差将及输出,同时将k时刻状态量与误差协方差的估计值返回UKF滤波器,用于获得k+1时刻的输出。
本发明的原理是:利用惯性/视觉导航***获得相对位置和姿态误差,但精度不高。利用天文导航***获得星光矢量,减弱姿态误差对导航精度的影响,获得精度更高的姿态信息。利用激光测距仪获得沿波束方向到实际月面的斜距,进一步修正高度误差。依据惯性导航误差方程建立着陆器的状态模型,分别建立惯性/视觉导航***相对位置和姿态误差、星光矢量及激光测距的量测模型,并使用UKF滤波估计着陆器的位置、速度和姿态。
本发明与现有技术相比的优点在于:
(1)本发明采用多种导航方法并基于信息融合技术进行组合导航,能够实现各个导航方法间的取长补短和优势互补,最大限度地提高导航的精度和可靠性,实现对航天器的高精度自主导航。
(2)现有着陆器导航技术中,大多数组合导航只单独地修正位置、速度或姿态,无法获得较为精确的位置、速度与姿态信息,甚至于只采用单一的导航方法,只得到单一的位置、速度或者位置、姿态信息,无法获得全面的导航信息。本发明提出一种月球着陆器的惯性/视觉/天文/激光测距导航方法,在传统的惯性/视觉导航基础上,辅助天文与激光测距导航,能够获得较为全面准确的位置、速度与姿态信息。
(3)当着陆器在月球背面下降着陆时,引入天体方向矢量量测信息和激光测距信息,能够更准确的修正位置与姿态信息,大幅度提高了姿态、位置及速度精度。
附图说明
图1为本发明中月球着陆器的惯性/视觉/天文/激光测距组合导航方法***流程图;
图2为本发明中月球着陆器的惯性/视觉/天文/激光测距组合导航方法原理图;
图3为本发明中导航坐标系示意图。
具体实施方式
图1给出了月球着陆器的惯性/视觉/天文/激光测距组合导航方法***流程图。接下来详细说明本发明的具体实施过程:
1、建立基于惯性导航误差方程的***状态模型
以月球固连坐标系下惯性导航的误差方程作为***状态模型:
其中φ=[φE φN φU]T是姿态误差角,φE、φN、φU分别表示惯性导航***地理坐标系,即n系内东、北、天向的姿态误差;fn是n系下的比力矢量;是月球着陆器速度误差,δE、δN、δU分别表示惯性导航***东、北、天向的速度误差;δrn=[δL δλ δh]T是月球着陆器位置误差,δL、δλ、δh分别表示惯性导航***纬度误差、经度误差及高度误差;是月球着陆器在n系下的月球角速率,是的误差;是n系相对m系的旋转角速率在n系中的表示,是的误差,Rm为月球参考半径;是n系相对i系的转动角速度,ε=(εx εyεz)T是惯性导航***x、y、z三个方向的陀螺仪常值漂移,是惯性导航***x、y、z三个方向加速度计的常值偏置;所述m系是月球固连坐标系,i系为惯性坐标系;
上式状态模型(1)写为:
Xk=F(Xk-1,k-1)+Wk-1 (2)
其中状态量为分别为月球着陆器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,Xk,Xk-1分别为k时刻和k-1下的状态量,F(Xk-1,k-1)为惯性/视觉/天文/激光测距组合导航***非线性转移函数,Wk-1为过程噪声。
2、建立惯性/视觉导航***相对位置和姿态误差量测模型
惯性导航***(INS)根据陀螺仪和加速度计惯性传感器来测量线性加速度和角速率,并对测量值进行积分得到位置、速度和姿态信息,视觉导航***(VNS)通过对外界环境的感知来确定着陆器的位置和姿态变化,整合得到当前的位置和姿态,由于有些测量值是用不同的坐标系表示的,需要进行一些计算和变换,根据惯性/视觉导航***获得相对位置和姿态误差,将其作为量测量并建立量测模型:
通过INS获得相对旋转矩阵RINS,位置矢量TINS,表示为:
其中,表示惯性导航***下真实姿态矩阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,rINS(k)表示tk时刻惯性导航***下月球着陆器在月球固连坐标系下的观测位置矢量,表示tk-1时刻月球着陆器在地理坐标系中的姿态矩阵估计值,表示tk-1时刻月球着陆器的位置矢量估计值,姿态矩阵和位置rINS(k)表示为:
校正后tk-1时刻的估计误差满足:
则RINS与TINS最终表示为:
其中,Rerr是的估计误差,定义为 为tk时刻月球着陆器在地理坐标系中的真实姿态矩阵,表示tk-1时刻月球着陆器在地理坐标系中的真实姿态矩阵,r(k)是tk时刻月球着陆器在月球固连坐标系下的真实位置,r(k-1)是tk-1时刻月球着陆器在月球固连坐标系下的真实位置,δr(k)=rINS(k)-r(k)是rINS(k)的估计误差;
通过VNS获得相对旋转矩阵RVNS,位置矢量TVNS,表示为:
其中,△RVNS和△TVNS表示RVNS和TVNS的误差;
则INS和VNS之间的姿态误差表示为g(RINS·RT VNS):
g(RINS·RT VNS)=g(Rerr·△RVNS)≈g(Rerr)+g(△RVNS) (7)
当姿态误差角φ非常小时,将φ表示为Rerr的函数:
φ=g(Rerr) (8)
g(RINS·RT VNS)=g(Rerr·△RVNS)≈g(Rerr)+g(△RVNS)=φ+△φ (9)
INS和VNS之间的位置矢量误差表示为:
其中,rn,INS(k)=[LINS(k),λINS(k),hINS(k)]T是tk时刻惯性导航***下月球着陆器在地理坐标系下的位置矢量,位置误差δrn(k)=[△L(k),△λ(k),△h(k)]T,表示tk时刻惯性导航***下月球着陆器在月球固连坐标系下的观测姿态矩阵,表示tk时刻月球着陆器在月球固连坐标系下的真实姿态矩阵,是rn,INS(k)和δrn(k)的函数,表示为:
λ(k)=λINS(k)+△λ(k)
L(k)=LINS(k)+△L(k) (12)
h(k)=hINS(k)+△h(k)
式中,λINS(k)、LINS(k)及hINS(k)是tk时刻惯性导航***下月球着陆器所获得的经度、纬度和高度;△L(k)、△λ(k)及△h(k)是经度误差、纬度误差和高度误差。
把惯性/视觉导航***相对位置和姿态误差作为量测量Z1,建立相对位置和姿态误差量测模型的表达式:
其中g(·)是将姿态矩阵转换为欧拉角的函数,h1(·)表示非线性量测函数,V1=[△φ,△TVNS]是量测噪声矩阵。
3、建立星光矢量量测模型
当月球着陆器下降时,天文导航***通过观测天体提供姿态信息,天文导航***由星传感器和星图像处理软件组成,星敏感器捕获原始星图,预处理后,通过对星图的质心提取,得到星图的二维像素坐标,进而在星敏感器坐标系中表示出恒星星光方向矢量ss为:
其中,si=[xi,yi,zi]T=[cos△cosRA,cos△sinRA,sin△]T,是通过星象模式识别得到的惯性坐标系下的星光矢量,△,RA分别为天体的赤纬和赤经,是星敏感器的安装矩阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,Rerr是的估计误差,是从n坐标系到b坐标系的变换矩阵,是从m坐标系到n坐标系的变换矩阵,是从i坐标系到m坐标系的变换矩阵;
以星光矢量作为量测量Z2,建立星光矢量量测模型的表达式:
Z2=[sS]=h2(X)+V2 (15)
其中h2(·)表示星光矢量的非线性量测函数,V2表示星敏感器的量测噪声。
4、建立距离量测模型
利用激光测距仪获得月球着陆器相对月面的斜距,并以此作为量测量:
其中,kl为测距敏感器标度因数,Rm为月球参考半径,hm()为月球数字高程库,b为测距敏感器常值偏差,为本体系到月心惯性系的方向余弦阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,Rerr是的估计误差,是从n坐标系到b坐标系的变换矩阵,是从m坐标系到n坐标系的变换矩阵,是从i坐标系到m坐标系的变换矩阵,A1为激光测距波束在本体系指向,v3为测距敏感器测量噪声;
则基于距离的量测模型为:
Z3=[l]=h3(X)+V3 (17)
其中,h3(·)表示距离量测量的非线性量测函数,V3表示量测噪声。
5、进行UKF滤波获得着陆器的位置、速度及姿态估计
设惯性/视觉/天文/激光测距组合导航***的量测量Z=[Z1,Z2,Z3]T,量测噪声V=[V1,V2,V3]T,建立惯性/视觉/天文/激光测距组合导航***量测模型
由此得惯性/视觉/天文/激光测距组合导航***的状态模型与量测模型:
其中,F(Xk-1,k-1)为组合导航***非线性转移函数,H(Xk,k)为非线性量测函数,Wk-1及Vk分别表示过程与量测噪声,对式(19)通过UKF滤波获得月球着陆器的后验状态估计分别为月球着陆器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,以及后验误差协方差
具体步骤如下:
B.选取sigma采样点
C.传递sigma采样点并获得先验估计及先验误差协方差
式中,Qk为k时刻状态模型噪声协方差阵。
D.量测更新
计算预测量测协方差Pyy,k及互协方差Pxy,k:
其中Rk为k时刻***的量测噪声协方差阵。计算滤波增益Kk为:
图2给出了月球着陆器的惯性/视觉/天文/激光测距组合导航方法原理图,介绍了各个导航***的基本原理。
①惯性导航***
惯性导航***主要由惯性测量单元(IMU)和相应的惯导机械化组成,以牛顿力学定律为基础。IMU通常由三个正交加速度计和三个正交陀螺仪组成,整个组件以捷联方式安装在着陆器本体上。陀螺仪和加速度计分别获得着陆器相对惯性坐标系的角速度加计非引力加速度(比力)fb,将测量数据转换到n坐标系,就能够确定着陆器在导航坐标系中的位置、速度与姿态信息。
②视觉导航***
视觉导航***主要由双目摄像机和相应的视觉导航软件组成,该软件包括特征提取、立体匹配、特征跟踪、三维重建和运动估计。在获得一对立体图像时,对每幅图像进行特征提取,同时对得到的左右图像进行立体匹配。在拍摄一组新的图像时,对相邻的两幅图像之间进行特征跟踪。在匹配过程中加入唯一性约束对应约束和视差范围约束,以提高匹配精度。通过特征提取和跟踪,得到匹配特征点的像素坐标。本文采用尺度不变特征变换算法对进行特征提取和跟踪。
③天文导航***
天文导航***由星传感器和星图像处理软件组成。星敏感器是一种通过匹配导航恒星星图来确定惯性姿态的光学敏感器,对星敏感器捕获的原始星图进行预处理后,通过对星图质心提取,可以得到星图的二维像素坐标,进而可以在星敏感器坐标系中表示出恒星星光方向矢量,后进行星图匹配识别,获得着陆器的姿态信息。
④激光测距导航
激光测距导航主要由激光测距仪与测距波束装置组成。测距仪测量着陆器沿波束方向到实际月面的斜距,对其进行激光测距解算,可以较好的修正着陆器的高度。
基于惯性导航***的误差方程建立组合导航***状态模型,利用惯性/视觉导航***获得相对位置和姿态误差,利用天文导航***获得星光矢量,利用激光测距仪获得着陆器相对月面的距离,根据这些量测量获得***量测模型,运用无迹卡尔曼滤波算法进行滤波估计,实现着陆器的位置、速度与姿态估计。
图3给出了导航坐标系示意图,介绍了针对月球着陆器的惯性/视觉/天文/激光测距组合导航中涉及的常用坐标系,包括惯性坐标系(i系),月球固连坐标系(m系),地理坐标系(n系),着陆器本体坐标系(b系),相机坐标系(c系)。
①惯性坐标系(i系,Omxiyizi)
惯性坐标系的原点位于月球质心Om,zi轴垂直于赤道平面,且与月球自转角速率矢量的方向一致,xi轴在赤道平面内并指向春分点方向,yi轴与xi轴和zi轴均垂直,并构成右手直角坐标系。
②月球固连坐标系(m系,Omxmymzm)
月球固连坐标系的坐标原点位于月球质心Om,zm轴垂直于赤道平面,且与月球自转角速率矢量的方向一致,xm轴在赤道平面内并指向本初子午线,ym轴垂直于xm轴和zm轴,并构成右手直角坐标系。是从月球惯性坐标系到月球固连坐标系的变换矩阵,可表示为:
式中,tSHA是春分点格林时角,可通过观测时间查找天文历表获得。
③地理坐标系(n系,O xnynzn)
地理坐标系为当地东北天坐标系,其原点位于着陆器质心O,xn轴沿月球参考椭球的卯酉圈方向并指向东向,yn轴沿月球参考椭球的子午圈方向并指向北向,zn轴沿月球参考椭球的外法线方向指向天顶。是从地理坐标系到月球固连坐标系的变换矩阵,可表示为:
式中,Rx(90°-L)和Rz(90°+L)分别表示绕x轴和z轴的旋转矩阵,L,λ分别为着陆器所在位置的纬度和经度。
④着陆器本体坐标系(b系,O xbybzb)
着陆器本体坐标系原点位于着陆器质心O,xb轴指向着陆器右方,yb轴沿着陆器对称轴方向指向着陆器前方,zb轴垂直于xboyb平面并指向上方,构成右手直角坐标系。
⑤相机坐标系(c系,Ocxcyczc)
以左相机光心为原点,xc轴沿像素阵列指向右方,yc轴沿像素阵列指向下方,zc轴沿光轴指向视场方向。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (6)
1.一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,其特征在于:
第一步,在月球固连坐标系下,建立基于惯性导航误差方程的月球着陆器的状态模型;
第二步,再分别利用惯性/视觉导航***获得惯性导航***和视觉导航***的相对位置和姿态误差,利用天文导航***获得恒星的星光矢量,利用激光测距仪获得月球着陆器相对月面的距离作为量测量;
第三步,根据所述量测量分别建立惯性/视觉导航***相对位置和姿态误差量测模型、星光矢量量测模型及激光测距的量测模型;
第四步,基于第一步中的状态模型和第三步中的量测模型,采用UKF滤波估计月球着陆器的位置、速度和姿态,对月球着陆器的姿态误差和惯性器件误差进行修正。
2.根据权利要求1所述的一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,其特征在于:所述第一步,具体包括以下步骤:
以月球固连坐标系下惯性导航的误差方程作为***状态模型:
其中φ=[φE φN φU]T是姿态误差角,φE、φN、φU分别表示惯性导航***地理坐标系,即n系内东、北、天向的姿态误差;fn是n系下的比力矢量;是月球着陆器速度误差,δE、δN、δU分别表示惯性导航***东、北、天向的速度误差;δrn=[δL δλ δh]T是月球着陆器位置误差,δL、δλ、δh分别表示惯性导航***纬度误差、经度误差及高度误差;是月球着陆器在n系下的月球角速率,是的误差;是n系相对m系的旋转角速率在n系中的表示,是的误差,Rm为月球参考半径;是n系相对i系的转动角速度,ε=(εx εyεz)T是惯性导航***x、y、z三个方向的陀螺仪常值漂移,是惯性导航***x、y、z三个方向加速度计的常值偏置;所述m系是月球固连坐标系,i系为惯性坐标系;
上式状态模型(1)写为:
Xk=F(Xk-1,k-1)+Wk-1 (2)
3.根据权利要求1所述的一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,其特征在于:所述第三步中,建立惯性/视觉导航***相对位置和姿态误差量测模型为:
通过惯性导航***获得相对旋转矩阵RINS,位置矢量TINS,表示为:
其中,表示惯性导航***下真实姿态矩阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,rINS(k)表示tk时刻惯性导航***下月球着陆器在月球固连坐标系下的观测位置矢量,表示tk-1时刻月球着陆器在地理坐标系中的姿态矩阵估计值,表示tk-1时刻月球着陆器的位置矢量估计值,姿态矩阵和位置rINS(k)表示为:
校正后tk-1时刻的估计误差满足:
则RINS与TINS最终表示为:
其中,Rerr是的估计误差,定义为 为tk时刻月球着陆器在地理坐标系中的真实姿态矩阵,表示tk-1时刻月球着陆器在地理坐标系中的真实姿态矩阵,r(k)是tk时刻月球着陆器在月球固连坐标系下的真实位置,r(k-1)是tk-1时刻月球着陆器在月球固连坐标系下的真实位置,δr(k)=rINS(k)-r(k)是rINS(k)的估计误差;
通过视觉导航***获得相对旋转矩阵RVNS,位置矢量TVNS,表示为:
其中,△RVNS和△TVNS表示RVNS和TVNS的误差;
则惯性导航***和视觉导航***之间的姿态误差表示为g(RINS·RT VNS):
g(RINS·RT VNS)=g(Rerr·△RVNS)≈g(Rerr)+g(△RVNS) (7)
当姿态误差角φ非常小时,将φ表示为Rerr的函数:
φ=g(Rerr) (8)
g(RINS·RT VNS)=g(Rerr·△RVNS)≈g(Rerr)+g(△RVNS)=φ+△φ (9)
惯性导航***和视觉导航***之间的位置矢量误差表示为:
其中,rn,INS(k)=[LINS(k),λINS(k),hINS(k)]T是tk时刻惯性导航***下月球着陆器在地理坐标系下的位置矢量,位置误差δrn(k)=[△L(k),△λ(k),△h(k)]T,表示tk时刻惯性导航***下月球着陆器在月球固连坐标系下的观测姿态矩阵,表示tk时刻月球着陆器在月球固连坐标系下的真实姿态矩阵,是rn,INS(k)和δrn(k)的函数,表示为:
式中,λINS(k)、LINS(k)及hINS(k)是tk时刻惯性导航***下月球着陆器所获得的经度、纬度和高度;△L(k)、△λ(k)及△h(k)是经度误差、纬度误差和高度误差。
把惯性/视觉导航***相对位置和姿态误差作为量测量Z1,建立相对位置和姿态误差量测模型的表达式:
其中g(·)是将姿态矩阵转换为欧拉角的函数,h1(·)表示非线性量测函数,V1=[△φ,△TVNS]是量测噪声矩阵。
4.根据权利要求1所述的一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,其特征在于:所述第三步中,建立星光矢量量测模型如下:
当月球着陆器下降时,天文导航***通过观测天体提供姿态信息,天文导航***由星传感器和星图像处理软件组成,星敏感器捕获原始星图,预处理后,通过对星图的质心提取,得到星图的二维像素坐标,进而在星敏感器坐标系中表示出恒星星光方向矢量ss为:
其中,si=[xi,yi,zi]T=[cos△cosRA,cos△sinRA,sin△]T,是通过星象模式识别得到的惯性坐标系下的星光矢量,△,RA分别为天体的赤纬和赤经,是星敏感器的安装矩阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,Rerr是的估计误差,是从n坐标系到b坐标系的变换矩阵,是从m坐标系到n坐标系的变换矩阵,是从i坐标系到m坐标系的变换矩阵;
以星光矢量作为量测量Z2,建立星光矢量量测模型的表达式:
Z2=[sS]=h2(X)+V2 (15)
其中h2(·)表示星光矢量的非线性量测函数,V2表示星敏感器的量测噪声。
5.根据权利要求1所述的一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,其特征在于:所述第三步中,建立距离量测模型如下:
利用激光测距仪获得月球着陆器相对月面的斜距,并以此作为量测量:
其中,kl为测距敏感器标度因数,Rm为月球参考半径,hm()为月球数字高程库,b为测距敏感器常值偏差,为本体系到月心惯性系的方向余弦阵,表示tk时刻惯性导航***下月球着陆器在地理坐标系中的观测姿态矩阵,Rerr是的估计误差,是从n坐标系到b坐标系的变换矩阵,是从m坐标系到n坐标系的变换矩阵,是从i坐标系到m坐标系的变换矩阵,A1为激光测距波束在本体系指向,v3为测距敏感器测量噪声;
则基于距离的量测模型为:
Z3=[l]=h3(X)+V3 (17)
其中,h3(·)表示距离量测量的非线性量测函数,V3表示量测噪声。
6.根据权利要求1所述的一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法,其特征在于:所述第四步中,进行UKF滤波获得着陆器的位置、速度及姿态估计如下:
设惯性/视觉/天文/激光测距组合导航***的量测量Z=[Z1,Z2,Z3]T,量测噪声V=[V1,V2,V3]T,建立惯性/视觉/天文/激光测距组合导航***量测模型
由此得惯性/视觉/天文/激光测距组合导航***的状态模型与量测模型:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010810080.2A CN111947652B (zh) | 2020-08-13 | 2020-08-13 | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010810080.2A CN111947652B (zh) | 2020-08-13 | 2020-08-13 | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111947652A true CN111947652A (zh) | 2020-11-17 |
CN111947652B CN111947652B (zh) | 2022-09-20 |
Family
ID=73333024
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010810080.2A Active CN111947652B (zh) | 2020-08-13 | 2020-08-13 | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111947652B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112525204A (zh) * | 2020-12-14 | 2021-03-19 | 北京航空航天大学 | 一种航天器惯性和太阳多普勒速度组合导航方法 |
CN112595328A (zh) * | 2020-12-18 | 2021-04-02 | 西安空间无线电技术研究所 | 视觉辅助稀疏无线电测量的月球导航定位方法 |
CN113030517A (zh) * | 2021-02-18 | 2021-06-25 | 北京控制工程研究所 | 一种火星着陆过程利用测速敏感器的姿态修正方法 |
CN113551668A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 |
CN113551667A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
CN113624218A (zh) * | 2021-07-28 | 2021-11-09 | 中国电子科技集团公司第三十八研究所 | 一种基于图像处理的自动天文定向*** |
CN113844682A (zh) * | 2021-09-13 | 2021-12-28 | 北京控制工程研究所 | 一种火星edl过程大动态导航试验验证***及方法 |
CN113849003A (zh) * | 2021-10-13 | 2021-12-28 | 西安尹纳数智能科技有限公司 | 一种动中通天线运动隔离的控制方法 |
CN114111723A (zh) * | 2021-11-15 | 2022-03-01 | 北京航天计量测试技术研究所 | 一种基于动态小视场的天体捕获方法 |
CN114136315A (zh) * | 2021-11-30 | 2022-03-04 | 山东天星北斗信息科技有限公司 | 一种基于单目视觉辅助惯性组合导航方法及*** |
CN114485678A (zh) * | 2021-12-31 | 2022-05-13 | 上海航天控制技术研究所 | 天地一体月面着陆导航方法 |
CN114577205A (zh) * | 2022-02-10 | 2022-06-03 | 北京空间飞行器总体设计部 | 一种基于序列图像的行星软着陆自主导航陆标优选方法 |
CN114608564A (zh) * | 2022-05-11 | 2022-06-10 | 北京航空航天大学 | 一种基于夜间月光偏振-星光信息融合的组合定位方法 |
CN115494448A (zh) * | 2022-08-27 | 2022-12-20 | 西北工业大学 | 基于无线电信标合作信号的月球着陆器定位方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7366328B1 (ja) | 2023-03-06 | 2023-10-20 | 三菱電機株式会社 | 転倒リスク検知方法、転倒リスク検知装置、飛翔体及びプログラム |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103033189A (zh) * | 2012-12-26 | 2013-04-10 | 北京航空航天大学 | 一种深空探测巡视器惯性/视觉组合导航方法 |
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103472848A (zh) * | 2013-09-22 | 2013-12-25 | 上海无线电设备研究所 | 一种小行星探测器着陆姿态的雷达测量方法 |
RU2012157593A (ru) * | 2012-12-27 | 2014-07-10 | Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Московский Физико-Технический Институт (Государственный Университет)" | Способ наземной имитации полета космических аппаратов в космосе |
CN104764449A (zh) * | 2015-04-23 | 2015-07-08 | 北京航空航天大学 | 一种基于星历修正的捕获段深空探测器自主天文导航方法 |
CN105371840A (zh) * | 2015-10-30 | 2016-03-02 | 北京自动化控制设备研究所 | 一种惯性/视觉里程计/激光雷达的组合导航方法 |
CN110501024A (zh) * | 2019-04-11 | 2019-11-26 | 同济大学 | 一种车载ins/激光雷达组合导航***的量测误差补偿方法 |
CN111121766A (zh) * | 2019-12-17 | 2020-05-08 | 南京理工大学 | 一种基于星光矢量的天文与惯性组合导航方法 |
-
2020
- 2020-08-13 CN CN202010810080.2A patent/CN111947652B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103033189A (zh) * | 2012-12-26 | 2013-04-10 | 北京航空航天大学 | 一种深空探测巡视器惯性/视觉组合导航方法 |
RU2012157593A (ru) * | 2012-12-27 | 2014-07-10 | Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Московский Физико-Технический Институт (Государственный Университет)" | Способ наземной имитации полета космических аппаратов в космосе |
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103472848A (zh) * | 2013-09-22 | 2013-12-25 | 上海无线电设备研究所 | 一种小行星探测器着陆姿态的雷达测量方法 |
CN104764449A (zh) * | 2015-04-23 | 2015-07-08 | 北京航空航天大学 | 一种基于星历修正的捕获段深空探测器自主天文导航方法 |
CN105371840A (zh) * | 2015-10-30 | 2016-03-02 | 北京自动化控制设备研究所 | 一种惯性/视觉里程计/激光雷达的组合导航方法 |
CN110501024A (zh) * | 2019-04-11 | 2019-11-26 | 同济大学 | 一种车载ins/激光雷达组合导航***的量测误差补偿方法 |
CN111121766A (zh) * | 2019-12-17 | 2020-05-08 | 南京理工大学 | 一种基于星光矢量的天文与惯性组合导航方法 |
Non-Patent Citations (3)
Title |
---|
XIAOLIN NING,MINGZHEN GUI AND YONGZHI XU ETC.: "INS/VNS/CNS integrated navigation method for planetary rovers", 《 AEROSPACE SCIENCE AND TECHNOLOGY》 * |
吴伟仁,李骥,黄翔宇等: "惯导/测距/测速相结合的安全软着陆自主导航方法", 《宇航学报》 * |
杨东春等: "基于激光测距和惯导的非合作目标远程交会相对导航算法研究", 《上海航天》 * |
Cited By (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112525204A (zh) * | 2020-12-14 | 2021-03-19 | 北京航空航天大学 | 一种航天器惯性和太阳多普勒速度组合导航方法 |
CN112525204B (zh) * | 2020-12-14 | 2023-06-16 | 北京航空航天大学 | 一种航天器惯性和太阳多普勒速度组合导航方法 |
CN112595328A (zh) * | 2020-12-18 | 2021-04-02 | 西安空间无线电技术研究所 | 视觉辅助稀疏无线电测量的月球导航定位方法 |
CN112595328B (zh) * | 2020-12-18 | 2024-02-09 | 西安空间无线电技术研究所 | 视觉辅助稀疏无线电测量的月球导航定位方法 |
CN113030517B (zh) * | 2021-02-18 | 2022-10-28 | 北京控制工程研究所 | 一种火星着陆过程利用测速敏感器的姿态修正方法 |
CN113030517A (zh) * | 2021-02-18 | 2021-06-25 | 北京控制工程研究所 | 一种火星着陆过程利用测速敏感器的姿态修正方法 |
CN113551668A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 |
CN113551667A (zh) * | 2021-07-21 | 2021-10-26 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
CN113551668B (zh) * | 2021-07-21 | 2024-05-28 | 北京航空航天大学 | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 |
CN113551667B (zh) * | 2021-07-21 | 2024-05-24 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
CN113624218A (zh) * | 2021-07-28 | 2021-11-09 | 中国电子科技集团公司第三十八研究所 | 一种基于图像处理的自动天文定向*** |
CN113844682B (zh) * | 2021-09-13 | 2023-06-16 | 北京控制工程研究所 | 一种火星edl过程大动态导航试验验证***及方法 |
CN113844682A (zh) * | 2021-09-13 | 2021-12-28 | 北京控制工程研究所 | 一种火星edl过程大动态导航试验验证***及方法 |
CN113849003A (zh) * | 2021-10-13 | 2021-12-28 | 西安尹纳数智能科技有限公司 | 一种动中通天线运动隔离的控制方法 |
CN113849003B (zh) * | 2021-10-13 | 2024-04-26 | 复远芯(上海)科技有限公司 | 一种动中通天线运动隔离的控制方法 |
CN114111723A (zh) * | 2021-11-15 | 2022-03-01 | 北京航天计量测试技术研究所 | 一种基于动态小视场的天体捕获方法 |
CN114136315B (zh) * | 2021-11-30 | 2024-04-16 | 山东天星北斗信息科技有限公司 | 一种基于单目视觉辅助惯性组合导航方法及*** |
CN114136315A (zh) * | 2021-11-30 | 2022-03-04 | 山东天星北斗信息科技有限公司 | 一种基于单目视觉辅助惯性组合导航方法及*** |
CN114485678A (zh) * | 2021-12-31 | 2022-05-13 | 上海航天控制技术研究所 | 天地一体月面着陆导航方法 |
CN114485678B (zh) * | 2021-12-31 | 2023-09-12 | 上海航天控制技术研究所 | 天地一体月面着陆导航方法 |
CN114577205B (zh) * | 2022-02-10 | 2023-06-06 | 北京空间飞行器总体设计部 | 一种基于序列图像的行星软着陆自主导航陆标优选方法 |
CN114577205A (zh) * | 2022-02-10 | 2022-06-03 | 北京空间飞行器总体设计部 | 一种基于序列图像的行星软着陆自主导航陆标优选方法 |
CN114608564A (zh) * | 2022-05-11 | 2022-06-10 | 北京航空航天大学 | 一种基于夜间月光偏振-星光信息融合的组合定位方法 |
CN114608564B (zh) * | 2022-05-11 | 2022-07-29 | 北京航空航天大学 | 一种基于夜间月光偏振-星光信息融合的组合定位方法 |
CN115494448A (zh) * | 2022-08-27 | 2022-12-20 | 西北工业大学 | 基于无线电信标合作信号的月球着陆器定位方法 |
CN115494448B (zh) * | 2022-08-27 | 2024-04-26 | 西北工业大学 | 基于无线电信标合作信号的月球着陆器定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111947652B (zh) | 2022-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111947652B (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
CN106780699B (zh) | 一种基于sins/gps和里程计辅助的视觉slam方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN101344391B (zh) | 基于全功能太阳罗盘的月球车位姿自主确定方法 | |
US6876926B2 (en) | Method and system for processing pulse signals within an inertial navigation system | |
CN107449444B (zh) | 一种多星图姿态关联的星敏感器内参数标定方法 | |
CN109556631B (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航***对准方法 | |
CN103994763B (zh) | 一种火星车的sins/cns深组合导航***及其实现方法 | |
CN103900611B (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN113551668B (zh) | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 | |
CN111947653A (zh) | 一种月面巡视探测器双模式惯性/视觉/天文导航方法 | |
CN112197765B (zh) | 一种实现水下机器人精细导航的方法 | |
CN112325886B (zh) | 一种基于重力梯度仪和陀螺仪组合的航天器自主定姿*** | |
CN112562077B (zh) | 一种融合pdr和先验地图的行人室内定位方法 | |
CN107144278B (zh) | 一种基于多源特征的着陆器视觉导航方法 | |
CN109612438B (zh) | 一种虚拟共面条件约束下的空间目标初轨确定方法 | |
CN113029132B (zh) | 一种结合地面影像与恒星光行差测量的航天器导航方法 | |
CN112880669A (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
Lo et al. | The direct georeferencing application and performance analysis of uav helicopter in gcp-free area | |
CN111207773B (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN114690229A (zh) | 一种融合gps的移动机器人视觉惯性导航方法 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的*** | |
CN104501809A (zh) | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 | |
CN112525204A (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 |