CN114485620A - 融合轨道动力学的小行星探测器自主视觉定位系统及方法 - Google Patents

融合轨道动力学的小行星探测器自主视觉定位系统及方法 Download PDF

Info

Publication number
CN114485620A
CN114485620A CN202210110676.0A CN202210110676A CN114485620A CN 114485620 A CN114485620 A CN 114485620A CN 202210110676 A CN202210110676 A CN 202210110676A CN 114485620 A CN114485620 A CN 114485620A
Authority
CN
China
Prior art keywords
asteroid
positioning
orbit
detector
vision
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
Application number
CN202210110676.0A
Other languages
English (en)
Other versions
CN114485620B (zh
Inventor
樊铭瑞
牛文龙
彭晓东
李运
高辰
杨震
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
National Space Science Center of CAS
Original Assignee
National Space Science Center of CAS
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by National Space Science Center of CAS filed Critical National Space Science Center of CAS
Priority to CN202210110676.0A priority Critical patent/CN114485620B/zh
Publication of CN114485620A publication Critical patent/CN114485620A/zh
Application granted granted Critical
Publication of CN114485620B publication Critical patent/CN114485620B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3807—Creation or updating of map data characterised by the type of data
    • 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
    • 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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
    • 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/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3833—Creation or updating of map data characterised by the source of data
    • G01C21/3837—Data obtained from a single source
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/10—Internal combustion engine [ICE] based vehicles
    • Y02T10/40—Engine management systems

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)
  • Length Measuring Devices By Optical Means (AREA)
  • Image Analysis (AREA)
  • Image Processing (AREA)

Abstract

本发明涉及一种融合轨道动力学的小行星探测器自主视觉定位系统及方法。所述系统包括视觉传感器、视觉SLAM定位模块、引力场建模模块和轨道优化模块；视觉传感器用于拍摄小行星表面图像；视觉SLAM定位模块进行特征提取匹配与跟踪，并估计探测器位姿、修正视觉累积误差；引力场建模模块重构行星表面三维模型，并进行稠密重建，对点云进行网格化处理，再基于多面体法对小行星引力场建模；轨道优化模块根据估计的探测器位姿和引力场建模来分析反演视觉初始定轨误差并进行修正。本发明所述方法基于估计的探测器位姿和引力场建模求解行星不规则引力场，分析反演视觉初始定轨误差在轨道动力学中的传播过程，修正视觉定位累计误差，实现高精度导航定位。

Description

融合轨道动力学的小行星探测器自主视觉定位系统及方法
技术领域
本发明涉及小行星探测领域，具体涉及一种融合轨道动力学的小行星探测器自主视觉定位系统及方法。
背景技术
小行星探测以获取其资源成分、形态结构和运动特征等基本信息为目标，对于认识太阳系、研究生命起源和演化具有重大意义。由于小行星距离地球距离远，通讯传输延迟长，需要探测器在接近目标天体时具备自主探测能力，其中自主导航和表面建模是行星自主探测的关键技术，能实现获取航天器相对于小行星表面的位置、姿态及三维模型等基本信息。
传统航天器导航方式，一般基于累积误差不受控的惯性元件，或基于功耗较高、测量范围受限的激光雷达等主动传感器，在周期长、能耗有限的深空探测任务中应用效果有限。因此，深空自主导航系统普遍采用能耗低且能获取丰富图像信息的视觉导航系统。但是现有的行星视觉导航方法需要对小行星进行长期的绕飞观测，并且要求大量人工参与重建天体模型和标记路标特征，不适应未来自主探测导航的发展需求。另一方面，提前标记参考特征库的方法，容易受光照、尺度、视角变化影响，在特征提取和识别中引入误差，进而影响导航定位精度。
针对以上问题，本发明提出一种融合轨道动力学的深空探测器自主视觉定位方法，能在缺乏表面先验信息、无人工手动标记的场景下，通过融合轨道动力学的轨道改进技术实现探测器的高精度视觉导航，并快速建立小行星表面三维模型。该方法能优化探测器初始定位结果，从而实现高精度导航，能够为未来我国的深空探索提供有效技术支撑。
发明内容
本发明的目的是解决现有深空自主视觉导航系统需对小行星进行长时间的前期绕飞观测，同时提前标记的特征参考容易受光照、尺度、视角变化影响的问题。
为解决上述技术问题，本发明提出一种融合轨道动力学的深空探测器自主视觉定位系统及方法，能在缺乏表面先验信息、无人工手动标记的场景下，通过融合轨道动力学的轨道改进技术实现探测器的高精度视觉导航，并建立小行星表面三维模型。
本发明提供了一种融合轨道动力学的小行星探测器自主视觉定位系统，所述系统包括视觉传感器、视觉SLAM定位模块、引力场建模模块和轨道优化模块；
所述视觉传感器，用于拍摄小行星表面的图像信息；
所述视觉SLAM定位模块，用于接收相机拍摄的小行星表面的图像信息，并对小行星表面的图像特征进行提取匹配与跟踪，通过因子图优化算法估计探测器位姿，通过回环检测修正视觉累积误差；
所述引力场建模模块，用于接收相机拍摄的小行星表面的图像信息，并根据绕飞段的图像由SFM算法恢复相机运动并重构行星表面三维模型，通过MVS进行稠密重建，随后对点云进行网格化处理，再基于多面体法对不规则小行星引力场建模；
所述轨道优化模块，用于根据所述视觉SLAM定位模块估计的探测器相对小行星位置姿态和所述引力场建模模块求解的行星不规则引力场来分析反演视觉初始定轨误差在轨道动力学中的传播过程，并对视觉定位累计误差进行修正；
所述定位系统设计了一种基于轨道动力学的伪相对运动分析精确轨道优化算法，基于定位模块估计的探测器相对小行星位置姿态和引力场建模模块求解的行星不规则引力场，分析反演视觉初始定轨误差在轨道动力学中的传播过程，修正视觉定位累计误差，改善初始定位结果。
本发明提供了一种融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述方法包括以下步骤：
首先，通过视觉传感器获取小行星表面图像信息；
其次，视觉SLAM定位模块根据获取的图像信息对小行星表面的特征进行提取匹配，通过因子图优化算法估计探测器位姿，并进行回环检测；
同时，引力场建模模块根据获取的图像信息重构行星表面三维模型，实现基于多面体法的行星不规则引力场建模；
最后，轨道优化模块基于估计的探测器位姿和引力场建模求解行星不规则引力场，分析反演视觉初始定轨误差在轨道动力学中的传播过程，修正视觉定位累计误差，实现高精度导航定位。
作为上述技术方案的一种改进，所述方法在探测过程中进行坐标系定义：定义小行星固连坐标系为
Figure BDA0003494983990000021
并以此作为世界坐标系，其中，A为坐标系原点，通常是为小行星质心；定义探测器坐标系为
Figure BDA0003494983990000031
其中，S为探测器本体坐标系原点，在绕飞时
Figure BDA0003494983990000032
轴指向小行星质心，
Figure BDA0003494983990000033
为迹向方向，
Figure BDA0003494983990000034
为
Figure BDA0003494983990000035
及
Figure BDA0003494983990000036
叉乘结果；定义相机坐标系为
Figure BDA0003494983990000037
在设定中相机位于探测器正前方，三轴与探测器坐标系
Figure BDA0003494983990000038
一致；定义像平面坐标系为
Figure BDA0003494983990000039
作为上述技术方案的又一种改进，所述方法采用视觉SLAM相对定位算法对小行星表面特征进行提取，并根据提取的路标特征实时计算探测器相对于环境的位置和姿态，并建立环境地图；
所述视觉SLAM相对定位算法包括三个线程：追踪、局部建图及回环检测；
所述追踪线程主要负责根据输入图像提取特征进行初始位姿估计，并建立关键帧；所述局部建图线程根据关键帧建立局部地图；所述回环检测线程通过词袋模型检测候选帧是否回环，最后优化全局地图并更新。
作为上述技术方案的另一种改进，所述视觉SLAM相对定位算法对小行星表面进行特征提取时，使用ORB(Oriented FAST and Rotated BRIEF)特征提取算法进行特征提取，所述ORB特征提取算法使用增强的FAST(Features from Accelerated Segment Test)提取关键点，并使用方向归一化的BRIEF(Binary Robust Independent Elementary Features)描述子对关键点进行描述。
作为上述技术方案的再一种改进，所述追踪线程将输入的序列图像与地图点进行匹配计算相机位姿，具体步骤为：将第一帧图像的相机坐标系作为系统参考坐标系，通过序列图像的帧间匹配可以传递特征点的世界坐标，在帧间进行3D-3D对应估计可以求解参考坐标系与每帧图像对应的位姿关系；在前一帧追踪成功时，采用匀速运动模型或关键帧模型获得初始的位姿矩阵，再基于因子图优化模型最小化3D-2D重投影误差函数，迭代求解得到更优的位姿，其中误差函数为：
Figure BDA00034949839900000310
其中，
Figure BDA00034949839900000311
是系统参考坐标系相对于第i帧相机坐标系的旋转和平移向量，(uj,vj)为第j个特征点的像素坐标，N为匹配到的特征点总和，ρ()为Huber损失函数，用于外点的剔除，project()表示3D-2D重投影误差函数，Xj为第j个匹配点在参考坐标系中的x坐标，∑为和每个特征点的尺度相关的信息矩阵；
在对每帧影像进行以上操作的同时，所述局部建图线程负责在当前地图插入关键帧和筛选、产生新的地图点，实时地优化局部若干帧的位姿及相应3D点的位置，对误差进行修正。
作为上述技术方案的更一种改进，所述回环监测线程使用词袋模型，将每张图像构建为一个词袋向量，通过相似度度量：
Figure BDA0003494983990000041
其中，vi和vj为对应的两幅图像的词袋向量，来评价两幅图像的相似度得分，判断是否进行回环检测。
作为上述技术方案的还一种改进，所述方法通过从运动恢复结构(Structurefrom motion，SFM)结合多视角立体几何(Multi-view stereo，MVS)算法依靠绕飞拍摄的图像数据实现三维重建，具体流程为：
在输入小行星表面序列图像之后，先通过SFM算法恢复相机运动信息和内外参，建立行星表面稀疏点云，具体步骤为：利用SIFT算法进行特征提取和匹配，随后对图像对进行几何验证即求解基础矩阵F并去除外点；在初始化时选择重叠度较高的两张图像，并增量式地依次添加新的图像和其特征点云坐标；使用光束平差法(Bundle Adjustment，BA)优化相机内外参和特征点云，并将此作为MVS算法的输入；其中，光束平差法通过最小化重投影误差优化相机参数，定义n个空间点Pi＝[Xi,Yi,Zi]T在像素平面的投影坐标为ui＝[ui,vi]T，相机的旋转R和平移变换t的李群表示为T，K为相机内参矩阵，构建如下列公式所示的最小二乘问题：
Figure BDA0003494983990000042
其中，Si是距离尺度
来求解最优的相机位姿；
MVS稠密建图部分通过融合深度图实现，具体步骤为：首先由立体匹配PatchMatch算法进行视差估计得到深度图，并对深度图进行融合和滤波处理，并进一步生成点云的法向量，并使用泊松重建方法进行表面重建。
作为上述技术方案的进一步的改进，所述方法选择多面体法进行引力场重建，所述多面体法计算得到的引力势能和引力加速度分别是：
Figure BDA0003494983990000051
Figure BDA0003494983990000052
其中，U(r)表示引力势，G表示万有引力常量，ρ是小行星密度，e是edge，表示棱边，f是face，表示面片，r表示任一点(x,y,z)位置向量，re是该点到多面体上面A和面B棱边上一点(x0,y0,z0)的向量((x0-x),(y0-y),(z0-z))，面A和面B是多面体任意两个面；
Figure BDA0003494983990000053
其中，
Figure BDA0003494983990000054
是面A的单位法向量，
Figure BDA0003494983990000055
是面A的“顶点1到2”边的单位法向量，
Figure BDA0003494983990000056
分别是面B的单位法向量和“顶点2到1”边的单位法向量，
Figure BDA0003494983990000057
其中，|r1|、|r2|表示(x,y,z)到棱边两顶点的距离，e12是棱边长度，rf表示(x,y,z)到任意面内的任意一点(x1,y1,z1)的向量((x1-x),(y1-y),(z1-z))，
Figure BDA0003494983990000058
其中，
Figure BDA0003494983990000059
是任意面的单位法向量，
Figure BDA00034949839900000510
其中，β＝r1·(r2×r3)，α＝|r1||r2||r3|+|r1|(r2·r3)+|r2|(r3·r1)+|r3|(r1·r2)，r1、r2、r3是用来计算点到1、2、3顶点的向量，U(r)对r求导获得加速度g(r)。
作为上述技术方案的更进一步的改进，所述方法通过求解目标函数得到相对运动方程中的相关系数，进而反向解算出相对初始位置和速度，最终得到更为精确的探测器轨道估计结果，具体步骤为：
定义探测器在绕飞若干个周期之后，通过视觉SLAM估计的一系列状态结果为
Figure BDA00034949839900000511
其中时刻i＝{1,...,N}，位置rV＝[x,y,z]，旋转四元数qV＝[q0,qx,qy,qz]T，速度vV＝[vx,vy,vz]T，角速度ωV＝[ωx,ωy,ωz]T；
取某一时刻i的
Figure BDA00034949839900000512
作为输入，通过动力学方程可数值积分可递推出经过时间T之后的状态
Figure BDA00034949839900000513
及以
Figure BDA00034949839900000514
为初值的一条“预报轨道”；所述“预报轨道”的状态
Figure BDA00034949839900000515
相比于真实轨道该时刻的状态x(i)存在误差ΔU(i)，且轨道递推的误差随着时间i逐渐累积，因此ΔU(i+T)＞ΔU(i)，通过不断迭代搜索合适的初值
Figure BDA00034949839900000516
使得减少i+T时刻附近的误差，达到对
Figure BDA00034949839900000517
的进一步优化；
通过在真实轨道附近分布w(i)～N{0,δ}的视觉定位结果进行曲线拟合，获取符合运动学方程的精确轨道；选取
Figure BDA0003494983990000061
作为递推初值，在
Figure BDA0003494983990000062
区间选取m个递推结果：
Figure BDA0003494983990000063
与视觉对应状态求得的误差和作为约束，经过不断的误差反演求解最优的
Figure BDA0003494983990000064
使得：
Figure BDA0003494983990000065
则由
Figure BDA0003494983990000066
确定的一条符合真实运动学方程的轨道即为优化后的探测器定位结果。
本发明的优点在于，本发明所述融合轨道动力学的行星探测器自主视觉定位系统及方法相比于传统的深空自主视觉导航系统，具有以下优势：
1)该系统仅仅通过视觉传感器获取数据，利用视觉SLAM算法实现对探测器相对于小行星表面的定位，并通过回环检测算法优化定位累积误差；
2)通过多视角立体几何方法重建小行星的稠密地图，并实现基于多面体法的不规则小行星引力场建模，在保证效率的同时提高精度；
3)采用融合轨道动力学的航天器轨道改进方法，初衷就是最大限度的“挖掘”航天器轨道测量数据中的轨道信息，充分利用这些轨道信息来实现轨道精度的进一步提高。该改进方法的前提是航天器通过前述视觉SLAM技术的初定位基本完成，通过这些轨道信息并借助相关的数据处理方法，便可以实现定轨精度的改进。
附图说明
图1为本发明所述融合轨道动力学的小行星探测器自主定位系统框架图；
图2为本发明所述视觉SLAM定位算法的流程图；
图3为本发明所述引力场建模模块中的小行星稠密三维重建流程图；
图4为本发明所述融合轨道动力学模块的系统框架；
图5为探测器绕飞小行星模型Eros433的建模效果示意图；
图6为仿真引擎生成的小行星模型Eros433图像；
图7为视觉SLAM在Eros433定位结果示意图；
图8为融合轨道动力学改进前后x、y、z三轴的定位误差和轨迹定位误差对比图；
图9为小行星Eros433的相关效果图，其中，图9(a)为仿真模型图，图9(b)为重建模型图，图9(c)为多面体网格图；
图10为小行星Eros433的重建引力场示意图；
图11为重建引力场与真实引力场误差值示意图。
具体实施方式
以下结合实施例进一步说明本发明所提供的技术方案。
1.融合轨道动力学的行星探测器自主定位系统框架
如图1所示，为本发明所述融合轨道动力学的小行星探测器自主定位系统框架图，根据功能主要分为四个模块：
1)视觉传感器：其传感器硬件为相机，用于拍摄小行星表面的图像信息；
2)视觉SLAM定位模块：根据获取的小行星表面的图像信息对小行星表面的特征进行提取匹配与跟踪，通过因子图优化算法估计探测器位姿，通过回环检测修正视觉累积误差，提高定位精度。
3)引力场建模模块：根据绕飞段的图像由SFM算法恢复相机运动并重构行星表面三维模型，通过MVS进行稠密重建，随后对点云进行网格化处理，再基于多面体法对不规则小行星引力场建模。
4)轨道优化模块：设计了一种基于轨道动力学的伪相对运动分析精确轨道优化算法，基于定位模块估计的探测器相对小行星位置姿态和引力场建模模块求解的行星不规则引力场，分析反演视觉初始定轨误差在轨道动力学中的传播过程，修正视觉定位累计误差，改善初始定位结果，从而实现高精度导航。
2.融合轨道动力学的行星探测器自主定位技术实现
2.1坐标系定义
定义小行星固连坐标系为
Figure BDA0003494983990000071
并以此作为世界坐标系，其中A为坐标系原点，通常是为小行星质心。定义探测器坐标系为
Figure BDA0003494983990000072
原点为探测器本体坐标系原点S，为了保证探测过程中小行星始终处于相机视野中，在绕飞时
Figure BDA0003494983990000073
轴指向小行星质心，
Figure BDA0003494983990000074
迹向方向，
Figure BDA0003494983990000075
为
Figure BDA0003494983990000076
及
Figure BDA0003494983990000077
叉乘结果。定义相机坐标系为
Figure BDA0003494983990000078
在设定中相机位于探测器正前方，三轴与探测器坐标系
Figure BDA0003494983990000079
一致。定义像平面坐标系为
Figure BDA00034949839900000710
2.2视觉SLAM相对定位算法
视觉SLAM能根据通过视觉传感器传来的图像信息提取到的路标特征实时计算自身相对于环境的位置和姿态，并建立环境地图。如图2所示，为本发明所述视觉SLAM定位算法的流程图，算法包括三个线程：追踪、局部建图及回环检测。追踪线程包括提取ORB特征、初始位姿估计/重定位、跟踪局部地图、搜索关键帧四个过程：主要负责根据输入的双目图像提取特征进行初始位姿估计，并建立关键帧；局部建图线程包括插入关键帧、筛选地图点、产生新的地图点、局部集束调整、局部关键帧筛选五个过程：负责根据关键帧建立局部地图；回环检测线程包括选择候选帧、计算相似度、回环融合、优化本质图四个过程：负责通过词袋模型检测候选帧是否回环，最后优化全局地图并更新。
2.2.1特征提取
在航天器绕飞阶段，在成像时主要呈现表面纹理的灰度信息。一般小行星表面都是凸的，绝大部分小行星表面都被环境光照亮，阴影覆盖较小，提取特征和特征匹配时主要需要解决随轨道高度带来的尺度变化和角度变化。因此使用ORB(Oriented FAST andRotated BRIEF)特征进行特征提取，其是一种具有尺度不变性和旋转不变性的特征点描述方法，利用增强的FAST(Features from Accelerated Segment Test)提取关键点，并使用方向归一化的BRIEF(Binary Robust Independent Elementary Features)描述子对关键点进行描述。
2.2.2追踪
追踪进程将输入的序列图像与地图点进行匹配计算相机位姿。将第一帧图像的相机坐标系作为系统参考坐标系，通过序列图像的帧间匹配可以传递特征点的世界坐标，在帧间进行3D-3D对应估计可以求解参考坐标系与每帧图像对应的位姿关系。为了提高匹配精度降低误匹配，在前一帧追踪成功时，采用匀速运动模型或关键帧模型获得初始的位姿矩阵，再基于因子图优化模型最小化3D-2D重投影误差函数，迭代求解得到更优的位姿，其中误差函数为：
Figure BDA0003494983990000081
其中，
Figure BDA0003494983990000082
是系统参考坐标系相对于第i帧相机坐标系的旋转和平移向量，(uj,vj)为第j个特征点的像素坐标；N为匹配到的特征点总和；ρ()为Huber损失函数，用于外点的剔除；project()表示3D-2D重投影误差函数；Xj为第j个匹配点在参考坐标系中的x坐标；∑为和每个特征点的尺度相关的信息矩阵。
2.2.3局部建图
在对每帧影像进行以上操作的同时，局部建图线程负责在当前地图插入关键帧和筛选、产生新的地图点，实时地优化局部若干帧的位姿及相应3D点的位置，对误差进行修正。
2.2.4回环检测
由于视觉SLAM定位根据输入的序列图像增量式地进行帧间匹配并估计相机位姿，因此必然存在累积误差。探测器一旦再次回到之前抵达过的“关键帧”，就能通过“关键帧”的相互关联性进行有效的闭合回环，优化位姿、纠正累积误差。小行星绕飞轨迹大多为环形轨道，多次绕飞之后可以通过回环检测将视觉定位的误差约束在一定范围内，也为下一步融合轨道动力学提供基础。为实现回环检测本专利使用词袋模型，将每张图像构建为一个词袋向量，通过相似度度量：
Figure BDA0003494983990000091
其中，vi和vj为对应的两幅图像的词袋向量，来评价两幅图像的相似度得分，判断是否进行回环检测。
2.3小行星稠密建图及引力场建模算法
2.3.1小行星稠密三维重建
虽然视觉SLAM算法也能在实现定位的同时进行建图，但是由ORB算法提取的特征较为稀疏，存在较多的空洞和重建不完全区域，而且由于受到视觉的定位误差的影响导致精度较低，会影响后续引力场建模效果。一般小行星任务通过多视角立体几何方法重建小行星的稠密地图，主要包括从运动恢复结构(Structure from motion，SFM)结合多视角立体几何(Multi-view stereo，MVS)方法。多视角立体几何法相比于现有小行星任务常用的立体光度测量法(SPC，StereoPhotoclinometry)，仅靠绕飞拍摄的图像数据即可实现三维重建，其结果稳定性强且精度较高，是未来小行星探测任务中表面重建的主要技术之一。
算法流程如图3所示，在输入小行星表面序列图像之后，先通过SFM算法恢复相机运动信息和内外参，建立行星表面稀疏点云。首先利用SIFT算法进行特征提取和匹配，随后对图像对进行几何验证即求解基础矩阵F并去除外点。在初始化时选择重叠度较高的两张图像，对其进行图像注册及三角化处理，并增量式地依次添加新的图像和其特征点云坐标；为了减少误差，在每次添加图像之后，对其进行光束调整：使用光束平差法(BundleAdjustment，BA)优化相机内外参和特征点云，这里可循环进行使误差不断减小以满足需求，建立行星表面稀疏点云，求解最优的相机位姿，并将此作为MVS算法的输入。其中光束平差法通过最小化重投影误差优化相机参数，定义n个空间点Pi＝[Xi,Yi,Zi]T在像素平面的投影坐标为ui＝[ui,vi]T，相机的旋转R和平移变换t的李群表示为T，K为相机内参矩阵，构建如下式所示的最小二乘问题，求解最优的相机位姿。
Figure BDA0003494983990000101
其中，Si是距离尺度。
MVS稠密建图部分通过融合深度图实现。首先由立体匹配PatchMatch算法进行视差估计得到深度图，并对深度图进行融合和滤波处理。由于多面体法需要用到模型表面的三角面片，因此还需要进一步生成点云的法向量，并使用泊松重建方法进行表面重建。
2.3.2引力场建模算法
重建完成后，本发明所述方法选择多面体法进行引力场建模。多面体法(Polyhedron Method)是不规则小行星引力场建模的主要方法之一，目前理论分析中多以该方法所得结果为精确值，其相对于球谐函数法和质点群法，具有更高的精度。考虑到探测器高精度导航的需求，因此本专利主要选择多面体法进行引力场重建。
多面体法计算得到的引力势能和引力加速度分别是：
Figure BDA0003494983990000102
Figure BDA0003494983990000103
其中，U(r)表示引力势，G表示万有引力常量，ρ是小行星密度，e是edge，表示棱边，f是face，表示面片，r表示任一点(x,y,z)位置向量，re是该点到多面体上面A和面B棱边上一点(x0,y0,z0)的向量((x0-x),(y0-y),(z0-z))，面A和面B是多面体任意两个面；
Figure BDA0003494983990000104
其中，
Figure BDA0003494983990000105
是面A的单位法向量，
Figure BDA0003494983990000106
是面A的“顶点1到2”边的单位法向量，
Figure BDA0003494983990000111
分别是面B的单位法向量和“顶点2到1”边的单位法向量；
Figure BDA0003494983990000112
其中，|r1|、|r2|表示(x,y,z)到棱边两顶点的距离，e12是棱边长度，rf表示(x,y,z)到任一面内的任意一点(x1,y1,z1)的向量((x1-x),(y1-y),(z1-z))，
Figure BDA0003494983990000113
其中，
Figure BDA0003494983990000114
是任一面的单位法向量，
Figure BDA0003494983990000115
其中，β＝r1·(r2×r3)，α＝|r1||r2||r3|+|r1|(r2·r3)+|r2|(r3·r1)+|r3|(r1·r2)，r1、r2、r3是用来计算点到1、2、3顶点的向量，U(r)对r求导获得加速度g(r)。
2.4伪轨道动力学修正算法
采用融合轨道动力学的航天器轨道改进方法，初衷就是最大限度的“挖掘”航天器轨道测量数据中的轨道信息，充分利用这些轨道信息来实现轨道精度的进一步提高。该改进方法的前提是航天器通过前述视觉SLAM技术的初定位基本完成，通过这些轨道信息并借助本专利提出的处理方法，便可以实现定轨精度的改进。
如图4所示，为融合轨道动力学实现探测器轨道估计优化模块的系统框架，该框架一方面将视觉SLAM技术对小行星探测器的位姿估计结果作为航天器初定轨结果，得到观测轨道；另一方面将基于视觉信息的小行星高精度三维重建模型通过多面体法完成小行星引力场建模，将航天器初定轨的数据作为初值输入高精度轨道动力学模型，进而得到其高精度轨道动力学模型，再通过动力学积分得到预报轨道，通过观测轨道和预测轨道可以计算得到轨道误差值。然后，将观测轨道和预报轨道分别输入基于“伪相对运动”的探测器轨道优化算法，通过求解目标函数得到相对运动方程中的相关系数，进而反向解算出相对初始位置和速度，最终得到更为精确的探测器轨道估计结果。
定义探测器在绕飞若干个周期之后，通过视觉SLAM估计的一系列状态结果为
Figure BDA0003494983990000116
其中时刻i＝{1,...,N}，位置rV＝[x,y,z]，旋转四元数qV＝[q0,qx,qy,qz]T，速度vV＝[vx,vy,vz]T，角速度ωV＝[ωx,ωy,ωz]T。假设只考虑小天体本身引力作用，不考虑太阳光压力等其他摄动力。其中引力加速度已经由重建模型利用多面体加速度计算模型给出，取某一时刻i的
Figure BDA0003494983990000117
作为输入，通过动力学方程可数值积分可递推出经过时间T之后的状态
Figure BDA0003494983990000118
及以
Figure BDA0003494983990000119
为初值的一条“预报轨道”，由于其不真实存在，因此称为“伪轨道”。由于
Figure BDA0003494983990000121
相比于真实轨道该时刻的状态x(i)存在误差ΔU(i)，且轨道递推的误差是随着时间i逐渐累积的，因此ΔU(i+T)＞ΔU(i)，通过不断迭代搜索合适的初值
Figure BDA0003494983990000122
使得减少i+T时刻附近的误差，就可以达到对
Figure BDA0003494983990000123
的进一步优化。
因为真实轨道是未知的，只能通过在真实轨道附近分布w(i)～N{0,δ}的视觉定位结果进行曲线拟合，获取符合运动学方程的精确轨道。选取
Figure BDA0003494983990000124
作为递推初值，在
Figure BDA0003494983990000125
区间选取m个递推结果：
Figure BDA0003494983990000126
与视觉对应状态求得的误差和作为约束，经过不断的误差反演求解最优的
Figure BDA0003494983990000127
使得：
Figure BDA0003494983990000128
则由
Figure BDA0003494983990000129
确定的一条符合真实运动学方程的轨道即为优化后的探测器定位结果。
3.仿真验证与分析
3.1实验数据构建
为了对本发明所述方法进行仿真验证，本实施例选用NASA官方公布的小行星模型Eros433，该模型最长轴为13km，最短轴为33km，平均密度为2670kg/m3。该模型包括小行星的三维结构，纹理信息采用Unreal Engine引擎中提供的小行星表面纹理，可视化效果如图5所示，即为探测器绕飞小行星的建模效果。
使用该小行星模型，并参考真实引力场通过轨道动力学模型生成仿真绕飞的探测轨道。此轨道距离小行星质心的最小距离为14.3km，最大距离为26.4km，轨道的时间间隔为50秒。通过程序控制摄像机按指定轨道绕飞小行星，可以实现小行星全部区域的探测而不产生盲区。在绕飞过程中探测器朝向始终保持对准小行星质心，同时视场相机拍摄行星表面图像，系统输出每张图像对应的时间戳、相机位置及旋转四元数，其可作为位姿估计精度评估过程中的真值(Ground Truth，GT)。最终在轨拍摄时间60000s，共生成1201张图像，如图6所示，即为仿真引擎生成图像。相机分辨率为1024*1024，视场角为15°。
3.2视觉SLAM相对定位实验及分析
通过观测图像提取ORB特征点并进行匹配，能实时获取探测器的相对位姿信息。由于视觉SLAM得到的是相机坐标系下的相对定位结果，为了对比分析算法精度，将相机坐标系转换到世界坐标系下。由图7看出视觉定位结果与真实轨道基本一致。
视觉的定位结果与真值误差对比如图8所示，分别对比了x、y、z三轴的定位误差和轨迹定位误差，其中横坐标表示时间戳，单位是s，纵坐标表示误差，单位为km。
在实际工程应用中，经常通过绝对轨迹误差(Absolute Pose Error,APE)来评价算法的估计轨迹与真实轨迹的差异。假设系统真实轨迹为Tgt,i，估计的轨迹为Testi,i，其中i＝1,2,···,N，那么绝对轨迹误差则表征了每个时刻位姿李代数的均方根误差(Root-Mean-Squared,RMSE)，其数学定义如下式所示：
Figure BDA0003494983990000131
计算求解得到视觉定位的均方根误差为116.97m，误差最大值为203.86m，均值为103.33m。绕飞轨道大致可以认为环绕小行星飞行两圈，从图8的三轴和总体的误差趋势也能看到定位误差所代表的实线曲线呈周期性变化，同时在30000s前后探测器又回到了初始点位置附近。由于回环检测算法在此匹配到之前的关键帧，累积误差被修正，整体误差在一个周期内呈现先变大后变小的趋势，这是因为随着时间的增加，误差会逐渐累积，校正后能将误差降低。该结果验证了自主视觉定位算法的有效性，并进一步肯定了视觉SLAM技术应用于小行星绕飞轨道估计的可行性，但误差仍有进一步提升空间。
3.3小行星稠密建图及引力场建模实验及分析
根据输入的序列图像对小行星进行表面三维重建，得到如图9(b)所示的稠密点云模型，总计168743897个点，外形与Unreal仿真引擎中的小行星形态，图9(a)所示，基本一致。
为了便于重建不规则小行星的引力场模型，考虑到引力场反演和轨道计算所需的时间，本实施例使用MeshLab工具将点云模型简化至902个点，并通过泊松重建算法对曲面进行重建，生成由1800个三角面片构成的多面体网格，如图9(c)所示。
通过多面体法实现多面体网格的引力场重建，获得其重新建模的加速度精度，得到近地表面的引力加速度分布如图10所示。
如图11所示，为重建引力场与真实引力场误差值示意图。与真实引力场模型下的加速度进行对比，图11计算得到的引力场误差均值为2.9232×10-8km/s2，最大值为3.6549×10-7km/s2，最小值为1.2825×10-9km/s2，误差占比均值为0.75％，最大不超过7.31％，引力场建模精度能满足任务需求。
3.4伪轨道动力学修正实验及分析
选取5000s处的纯视觉定位结果作为初值输入，在整体轨道60000s上间隔1000s均匀采样60个点作为约束，不断迭代优化，获得融合轨道动力学之后的结果，误差如图8虚线曲线所示，可以看出无论是各个分量的误差还是总体误差，皆比未优化前的精度要高。
表1视觉SLAM和融合轨道动力学后的定位误差对比
Figure BDA0003494983990000141
根据表1的统计结果，融合轨道动力学的改进方法将原先均值为103.33米、均方根误差为116.97米的视觉定位误差降低至均值为59.61米，均方根误差为65.602米的水平，精度提升43.92％，可以满足未来小行星自主探测任务中的定位要求。因此融合轨道动力学进行视觉轨道优化后的轨道误差能将视觉SLAM定位误差进一步降低。
从上述对本发明的具体描述可以看出，本发明提出的一种融合轨道动力学的小行星探测器自主视觉定位系统及方法通过融合轨道动力学的轨道改进技术实现探测器的高精度视觉导航，并快速建立小行星表面三维模型，并且能够优化探测器初始定位结果，从而实现高精度导航，能够为未来我国的深空探索提供有效技术支撑。
最后应说明的是，以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，对本发明的技术方案进行修改或者等同替换，都不脱离本发明技术方案的精神和范围，其均应涵盖在本发明的权利要求范围当中。

Claims (10)

1.一种融合轨道动力学的小行星探测器自主视觉定位系统，其特征在于，所述系统包括视觉传感器、视觉SLAM定位模块、引力场建模模块和轨道优化模块；
所述视觉传感器，用于拍摄小行星表面的图像信息；
所述视觉SLAM定位模块，用于接收相机拍摄的小行星表面的图像信息，并对小行星表面的图像特征进行提取匹配与跟踪，通过因子图优化算法估计探测器位姿，通过回环检测修正视觉累积误差；
所述引力场建模模块，用于接收相机拍摄的小行星表面的图像信息，并根据绕飞段的图像由SFM算法恢复相机运动并重构行星表面三维模型，通过MVS进行稠密重建，随后对点云进行网格化处理，再基于多面体法对不规则小行星引力场建模；
所述轨道优化模块，用于根据所述视觉SLAM定位模块估计的探测器相对小行星位置姿态和所述引力场建模模块求解的行星不规则引力场来分析反演视觉初始定轨误差在轨道动力学中的传播过程，并对视觉定位累计误差进行修正；
所述定位系统设计了一种基于轨道动力学的伪相对运动分析精确轨道优化算法，基于定位模块估计的探测器相对小行星位置姿态和引力场建模模块求解的行星不规则引力场，分析反演视觉初始定轨误差在轨道动力学中的传播过程，修正视觉定位累计误差，改善初始定位结果。
2.一种融合轨道动力学的小行星探测器自主视觉定位方法，所述方法包括以下步骤：
首先，通过视觉传感器获取小行星表面图像信息；
其次，视觉SLAM定位模块根据获取的图像信息对小行星表面的特征进行提取匹配，通过因子图优化算法估计探测器位姿，并进行回环检测；
同时，引力场建模模块根据获取的图像信息重构行星表面三维模型，实现基于多面体法的行星不规则引力场建模；
最后，轨道优化模块基于估计的探测器位姿和引力场建模求解行星不规则引力场，分析反演视觉初始定轨误差在轨道动力学中的传播过程，修正视觉定位累计误差，实现高精度导航定位。
3.根据权利要求2所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述方法在探测过程中进行坐标系定义：定义小行星固连坐标系为
Figure FDA0003494983980000011
并以此作为世界坐标系，其中，A为坐标系原点，通常是为小行星质心；定义探测器坐标系为
Figure FDA0003494983980000021
其中，S为探测器本体坐标系原点，在绕飞时
Figure FDA0003494983980000022
轴指向小行星质心，
Figure FDA0003494983980000023
为迹向方向，
Figure FDA0003494983980000024
为
Figure FDA0003494983980000025
及
Figure FDA0003494983980000026
叉乘结果；定义相机坐标系为
Figure FDA0003494983980000027
在设定中相机位于探测器正前方，三轴与探测器坐标系
Figure FDA0003494983980000028
一致；定义像平面坐标系为
Figure FDA0003494983980000029
4.根据权利要求2所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述方法采用视觉SLAM相对定位算法对小行星表面特征进行提取，并根据提取的路标特征实时计算探测器相对于环境的位置和姿态，并建立环境地图；
所述视觉SLAM相对定位算法包括三个线程：追踪、局部建图及回环检测；
所述追踪线程主要负责根据输入图像提取特征进行初始位姿估计，并建立关键帧；
所述局部建图线程根据关键帧建立局部地图；
所述回环检测线程通过词袋模型检测候选帧是否回环，最后优化全局地图并更新。
5.根据权利要求4所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述视觉SLAM相对定位算法对小行星表面进行特征提取时，使用ORB特征提取算法进行特征提取，所述ORB特征提取算法使用增强的FAST提取关键点，并使用方向归一化的BRIEF描述子对关键点进行描述。
6.根据权利要求4所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述追踪线程将输入的序列图像与地图点进行匹配计算相机位姿，具体步骤为：将第一帧图像的相机坐标系作为系统参考坐标系，通过序列图像的帧间匹配可以传递特征点的世界坐标，在帧间进行3D-3D对应估计可以求解参考坐标系与每帧图像对应的位姿关系；在前一帧追踪成功时，采用匀速运动模型或关键帧模型获得初始的位姿矩阵，再基于因子图优化模型最小化3D-2D重投影误差函数，迭代求解得到更优的位姿，其中误差函数为：
Figure FDA00034949839800000210
其中，
Figure FDA00034949839800000211
是系统参考坐标系相对于第i帧相机坐标系的旋转和平移向量，(uj,vj)为第j个特征点的像素坐标，N为匹配到的特征点总和，ρ()为Huber损失函数，project()表示3D-2D重投影误差函数，Xj为第j个匹配点在参考坐标系中的x坐标，∈为和每个特征点的尺度相关的信息矩阵；
在对每帧影像进行以上操作的同时，所述局部建图线程负责在当前地图插入关键帧和筛选、产生新的地图点，实时地优化局部若干帧的位姿及相应3D点的位置，对误差进行修正。
7.根据权利要求4所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述回环监测线程使用词袋模型，将每张图像构建为一个词袋向量，通过相似度度量：
Figure FDA0003494983980000031
其中，vi和vj为对应的两幅图像的词袋向量，来评价两幅图像的相似度得分，判断是否进行回环检测。
8.根据权利要求2所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述方法通过从运动恢复结构(SFM)结合多视角立体几何(MVS)算法依靠绕飞拍摄的图像数据实现三维重建，具体流程为：
在输入小行星表面序列图像之后，先通过SFM算法恢复相机运动信息和内外参，建立行星表面稀疏点云，具体步骤为：利用SIFT算法进行特征提取和匹配，随后对图像对进行几何验证即求解基础矩阵F并去除外点；在初始化时选择重叠度较高的两张图像，并增量式地依次添加新的图像和其特征点云坐标；使用光束平差法优化相机内外参和特征点云，并将此作为MVS算法的输入；其中，光束平差法通过最小化重投影误差优化相机参数，定义n个空间点Pi＝[Xi,Yi,Zi]T在像素平面的投影坐标为ui＝[ui,vi]T，相机的旋转R和平移变换t的李群表示为T，K为相机内参矩阵，构建如下列公式所示的最小二乘问题：
Figure FDA0003494983980000032
其中，Si是距离尺度来求解最优的相机位姿；
MVS稠密建图部分通过融合深度图实现，具体步骤为：首先由立体匹配PatchMatch算法进行视差估计得到深度图，并对深度图进行融合和滤波处理，并进一步生成点云的法向量，并使用泊松重建方法进行表面重建。
9.根据权利要求2所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述方法选择多面体法进行引力场重建，所述多面体法计算得到的引力势能和引力加速度分别是：
Figure FDA0003494983980000041
Figure FDA0003494983980000042
其中，U(r)表示引力势，G表示万有引力常量，ρ是小行星密度，e是edge，表示棱边，f是face，表示面片，r表示任一点(x,y,z)位置向量，re是该点到多面体上面A和面B棱边上一点(x0,y0,z0)的向量((x0-x),(y0-y),(z0-z))，面A和面B是多面体任意两个面；
Figure FDA0003494983980000043
其中，
Figure FDA0003494983980000044
是面A的单位法向量，
Figure FDA0003494983980000045
是面A的“顶点1到2”边的单位法向量，
Figure FDA0003494983980000046
分别是面B的单位法向量和“顶点2到1”边的单位法向量，
Figure FDA0003494983980000047
其中，|r1|、|r2|表示(x,y,z)到棱边两顶点的距离，e12是棱边长度，rf表示(x,y,z)到任意面内的任意一点(x1,y1,z1)的向量((x1-x),(y1-y),(z1-z))，
Figure FDA0003494983980000048
其中
Figure FDA0003494983980000049
是任意面的单位法向量，
Figure FDA00034949839800000410
其中，β＝r1·(r2×r3)，α＝|r1||r2||r3|+|r1|(r2·r3)+|r2|(r3·r1)+|r3|(r1·r2)，r1、r2、r3是用来计算点到1、2、3顶点的向量，U(r)对r求导获得加速度g(r)。
10.根据权利要求2所述的融合轨道动力学的小行星探测器自主视觉定位方法，其特征在于，所述方法通过求解目标函数得到相对运动方程中的相关系数，进而反向解算出相对初始位置和速度，最终得到更为精确的探测器轨道估计结果，具体步骤为：
定义探测器在绕飞若干个周期之后，通过视觉SLAM估计的一系列状态结果为
Figure FDA00034949839800000411
其中时刻i＝{1,...,N}，位置rV＝[x,y,z]，旋转四元数qV＝[q0,qx,qy,qz]T，速度vV＝[vx,vy,vz]T，角速度ωV＝[ωx,ωy,ωz]T；
取某一时刻i的
Figure FDA00034949839800000412
作为输入，通过动力学方程可数值积分可递推出经过时间T之后的状态
Figure FDA00034949839800000413
及以
Figure FDA00034949839800000414
为初值的一条“预报轨道”；所述“预报轨道”的状态
Figure FDA0003494983980000051
相比于真实轨道该时刻的状态x(i)存在误差ΔU(i)，且轨道递推的误差随着时间i逐渐累积，因此ΔU(i+T)＞ΔU(i)，通过不断迭代搜索合适的初值
Figure FDA0003494983980000052
使得减少i+T时刻附近的误差，达到对
Figure FDA0003494983980000053
的进一步优化；
通过在真实轨道附近分布w(i)～N{0,δ}的视觉定位结果进行曲线拟合，获取符合运动学方程的精确轨道；选取
Figure FDA0003494983980000054
作为递推初值，在
Figure FDA0003494983980000055
区间选取m个递推结果：
Figure FDA0003494983980000056
与视觉对应状态求得的误差和作为约束，经过不断的误差反演求解最优的
Figure FDA0003494983980000057
使得：
Figure FDA0003494983980000058
则由
Figure FDA0003494983980000059
确定的一条符合真实运动学方程的轨道即为优化后的探测器定位结果。
CN202210110676.0A 2022-01-29 2022-01-29 融合轨道动力学的小行星探测器自主视觉定位系统及方法 Active CN114485620B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210110676.0A CN114485620B (zh) 2022-01-29 2022-01-29 融合轨道动力学的小行星探测器自主视觉定位系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210110676.0A CN114485620B (zh) 2022-01-29 2022-01-29 融合轨道动力学的小行星探测器自主视觉定位系统及方法

Publications (2)

Publication Number Publication Date
CN114485620A true CN114485620A (zh) 2022-05-13
CN114485620B CN114485620B (zh) 2023-07-28

Family

ID=81479162

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210110676.0A Active CN114485620B (zh) 2022-01-29 2022-01-29 融合轨道动力学的小行星探测器自主视觉定位系统及方法

Country Status (1)

Country Link
CN (1) CN114485620B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114742884A (zh) * 2022-06-09 2022-07-12 杭州迦智科技有限公司 一种基于纹理的建图、里程计算、定位方法及系统

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5966680A (en) * 1996-02-15 1999-10-12 Butnaru; Hanan Motion sickness/vertigo prevention device and method
US20110231094A1 (en) * 2008-12-05 2011-09-22 Thales Method for geolocating an object by multitelemetry
CN105910604A (zh) * 2016-05-25 2016-08-31 武汉卓拔科技有限公司 一种基于多传感器的自主避障导航系统
CN105934775A (zh) * 2013-11-26 2016-09-07 约阿夫·谢斐 用于构建锚定在真实世界物体上的虚拟图像的方法和系统
WO2018011498A1 (fr) * 2016-07-13 2018-01-18 Commissariat A L'energie Atomique Et Aux Energies Alternatives Procédé et système pour la localisation et la reconstruction en temps réel de la posture d'un objet mouvant à l'aide de capteurs embarqués
CN108665540A (zh) * 2018-03-16 2018-10-16 浙江工业大学 基于双目视觉特征和imu信息的机器人定位与地图构建系统
CN108717712A (zh) * 2018-05-29 2018-10-30 东北大学 一种基于地平面假设的视觉惯导slam方法
CN110889219A (zh) * 2019-11-22 2020-03-17 北京理工大学 基于器间测距的小天体引力场反演修正方法
CN111521176A (zh) * 2020-04-27 2020-08-11 北京工业大学 融合激光的视觉辅助惯性导航方法
CN112084581A (zh) * 2020-09-24 2020-12-15 中国人民解放军国防科技大学 一种航天器小推力摄动交会轨迹优化方法及系统
CN113722958A (zh) * 2021-08-30 2021-11-30 北京理工大学 一种不规则形状小天体引力场高效建模方法
CN113962119A (zh) * 2021-09-01 2022-01-21 北京理工大学 形状不规则双小行星系统相互作用高精度高效率建模方法

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5966680A (en) * 1996-02-15 1999-10-12 Butnaru; Hanan Motion sickness/vertigo prevention device and method
US20110231094A1 (en) * 2008-12-05 2011-09-22 Thales Method for geolocating an object by multitelemetry
CN105934775A (zh) * 2013-11-26 2016-09-07 约阿夫·谢斐 用于构建锚定在真实世界物体上的虚拟图像的方法和系统
US20160260256A1 (en) * 2013-11-26 2016-09-08 Visual Domains Ltd Method and System for Constructing a Virtual Image Anchored onto a Real-World Object
CN105910604A (zh) * 2016-05-25 2016-08-31 武汉卓拔科技有限公司 一种基于多传感器的自主避障导航系统
WO2018011498A1 (fr) * 2016-07-13 2018-01-18 Commissariat A L'energie Atomique Et Aux Energies Alternatives Procédé et système pour la localisation et la reconstruction en temps réel de la posture d'un objet mouvant à l'aide de capteurs embarqués
CN108665540A (zh) * 2018-03-16 2018-10-16 浙江工业大学 基于双目视觉特征和imu信息的机器人定位与地图构建系统
CN108717712A (zh) * 2018-05-29 2018-10-30 东北大学 一种基于地平面假设的视觉惯导slam方法
CN110889219A (zh) * 2019-11-22 2020-03-17 北京理工大学 基于器间测距的小天体引力场反演修正方法
CN111521176A (zh) * 2020-04-27 2020-08-11 北京工业大学 融合激光的视觉辅助惯性导航方法
CN112084581A (zh) * 2020-09-24 2020-12-15 中国人民解放军国防科技大学 一种航天器小推力摄动交会轨迹优化方法及系统
CN113722958A (zh) * 2021-08-30 2021-11-30 北京理工大学 一种不规则形状小天体引力场高效建模方法
CN113962119A (zh) * 2021-09-01 2022-01-21 北京理工大学 形状不规则双小行星系统相互作用高精度高效率建模方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
刘兴潭 等: "小行星三维地形模型几何重建方法", 空间控制技术与应用, vol. 46, no. 1 *
崔平远 等: "小天体附近轨道动力学与控制研究现状与展望", 力学进展, vol. 43, no. 5 *
李媛 等: "小行星场景下基于循环卷积网络的位姿估计方法", 传感器与微系统, vol. 39, no. 8 *
马虹: "基于5G的视觉辅助BDS移动机器人融合定位算法", 计算机科学, vol. 47, no. 6 *
高艾 等: "小行星探测器软着陆自主导航与制导方法研究", 中国宇航学会深空探测技术专委会第六届学术年会暨863计划"深空探测与空间实验技术"学术研讨会论文集 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114742884A (zh) * 2022-06-09 2022-07-12 杭州迦智科技有限公司 一种基于纹理的建图、里程计算、定位方法及系统
CN114742884B (zh) * 2022-06-09 2022-11-22 杭州迦智科技有限公司 一种基于纹理的建图、里程计算、定位方法及系统

Also Published As

Publication number Publication date
CN114485620B (zh) 2023-07-28

Similar Documents

Publication Publication Date Title
CN111156998B (zh) 一种基于rgb-d相机与imu信息融合的移动机器人定位方法
US10762645B2 (en) Stereo visual odometry method based on image gradient joint optimization
CN112902953B (zh) 一种基于slam技术的自主位姿测量方法
Peng et al. Pose measurement and motion estimation of space non-cooperative targets based on laser radar and stereo-vision fusion
CN102607526B (zh) 双介质下基于双目视觉的目标姿态测量方法
CN112347840A (zh) 视觉传感器激光雷达融合无人机定位与建图装置和方法
CN110726406A (zh) 一种改进的非线性优化单目惯导slam的方法
CN102607534B (zh) 基于运动恢复结构的卫星相对姿态测量方法
CN110849331B (zh) 基于三维点云数据库模型的单目视觉测量与地面试验方法
CN108917753B (zh) 基于从运动恢复结构的飞行器位置确定方法
CN109612438B (zh) 一种虚拟共面条件约束下的空间目标初轨确定方法
CN103871075B (zh) 一种大椭圆遥感卫星地球背景相对运动估计方法
CN111623773B (zh) 一种基于鱼眼视觉和惯性测量的目标定位方法及装置
CN114608554B (zh) 一种手持slam设备以及机器人即时定位与建图方法
CN110929402A (zh) 一种基于不确定分析的概率地形估计方法
CN111650579A (zh) 一种岩移参数自适应获取的InSAR矿区三维形变估计方法、装置及介质
Linares et al. Particle filtering light curve based attitude estimation for non-resolved space objects
CN114485620B (zh) 融合轨道动力学的小行星探测器自主视觉定位系统及方法
CN112857306A (zh) 一种视频卫星任意视向点的连续太阳高度角确定方法
Kupervasser et al. Robust positioning of drones for land use monitoring in strong terrain relief using vision-based navigation
CN111366162B (zh) 基于太阳帆板投影与模板匹配的小天体探测器位姿估计方法
Vassallo et al. Orbital slam
Rowell et al. Autonomous visual recognition of known surface landmarks for optical navigation around asteroids
Mirisola et al. Trajectory recovery and 3d mapping from rotation-compensated imagery for an airship
Baker et al. Limb-Based Shape Modeling: A Demonstration on Itokawa

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