基于观测矩阵的深空探测器自主导航路标选取方法技术

本发明专利技术涉及一种基于观测矩阵的深空探测器自主导航路标选取方法，特别适用于利用三个路标进行深空探测器位置和姿态自主确定的导航系统，属于自主导航领域。本发明专利技术通过读取导航路标在目标天体坐标系下的位置数据，计算出目标天体坐标系下ｎ个路标相对探测器的位置矢量；通过计算观测矩阵的行向量，得到观测矩阵Ｈ；计算任意三个导航路标组合所对应的矩阵（ＨＨＴ）－１的特征值之和，选取最优的三个导航路标。本发明专利技术的基于观测矩阵的深空探测器自主导航路标选取方法具有精度高、计算小、解析可行，为近目标天体飞行的深空探测提供了明确可行的导航路标选取方法。

【技术实现步骤摘要】

本专利技术涉及一种基于观测矩阵的深空探测器导航路标选取方法，特别适用于利用三个路标进行深空探测器位置和姿态自主确定的导航系统，属于自主导航领域。
技术介绍
近目标天体飞行将是未来深空探测最复杂的任务之一，由于通信延迟及深空动力学环境的复杂性，采用传统的基于地面遥控的导航、控制模式已无法满足实现高精度探测的需要，这要求探测器必须具有自主导航功能。由于惯性测量单元存在常值偏差和漂移，导航精度较低，同时随着导航相机等光学敏感器发展，以光学信息为主的深空探测器自主导航方法已成为研究热点。其中，针对目标天体表面存在大量陨石坑的地形特点，各国学者对其展开了大量的研究，利用这种地形特征作为导航路标的自主导航方法，具有较高的轨道确定性能。 基于路标导航的深空探测器自主光学导航方法已成为目前研究热点，其中如何在众多的导航路标中选取合适的路标以便达到期望的性能要求，是基于路标导航的一个关键技术，直接影响了软件算法的计算效率与探测器的自主定位能力，决定了探测任务是否能够成功完成，因此路标导航的自主选取方法是当前科技人员关注的重点问题之一。 在已发展的导航路标自主选取方法中，在先技术(参见Debo Sun，Crassidis J L.Observability Analysis of Six-Degree-of-Freedom ConfigurationDetermination Using Vector Observations.Journal of Guidance，Control，andDynamics.2002，25(6)1149-57)，以共线方程作为观测模型，通过极大似然估计理论得到相对位置、姿态估计系统的最优误差方差矩阵和费歇尔(Fisher)信息阵；接着，通过对误差方差阵和信息阵的秩、迹和特征值的分析来确定视线测量相对导航系统的可观性和可观度。这种方法能够定性地分析路标距离探测器远近对导航精度的影响，但却不能定量地对导航系统的可观度进行分析，无法给出探测器在轨自主选择导航路标的准则。 在先技术(参见Burschka D，Geiman J，Hager G.Optimal landmarkconfiguration for vision-based control of mobile robots.2003IEEE InternationalConference on Robotics and Automation.2003，33917-22)，利用观测矩阵的条件数对平面内移动的机器人的导航选取方法进行了研究，分析了导航路标的位置对导航精度的影响，并给出了导航路标的选取方法。但是这种方法只适合应用在平面二维运动空间内的物体，并不适用于深空探测器这种空间三维运动的物体。 在先技术(参见黄翔宇等.深空自主导航系统的可观性分析.宇航学报，2006，27(3)332-337)，利用误差协方阵的方式对导航路标的观测对导航精度的影响，该方法通过对误差协方差阵的奇异值分析，采用数值方法得到了导航路标位置对导航精度的影响程度。但是由于该方法采用的是数值计算方法，计算量大，因此这种方法只适合前期的任务分析及地面试验分析，而并不能应用于探测器在轨的自主导航路标选取。
技术实现思路
本专利技术的目的是为了解决目前基于路标导航的深空探测器尚没有精确可行的导航路标自主选取方法的问题，针对采用三路标的像素信息进行深空探测器位置、姿态自主确定的导航系统，提出一种。 本专利技术的目的是通过下述技术方案实现的。 本专利技术的，具体步骤如下 步骤1，读取导航路标在目标天体坐标系下的位置数据，计算目标天体坐标系下n个路标相对探测器的位置矢量 读取光学相机拍摄到的目标天体表面地形图像，从中提取到n个导航路标在目标天体坐标系下的位置矢量 及轨道预报给出的深空探测器相对目标天体的大致位置矢量 计算目标天体坐标系下n个路标相对探测器的位置矢量 步骤2，为得到观测矩阵H，利用步骤1得到的目标天体坐标系下n个路标相对探测器的位置矢量 计算观测矩阵的行向量 令和分别为第i个与第j个路标的单位视线向量(ri和rj为第i个与第j个路标到探测器的距离)，对n个导航路标中第i个和第j个路标组合的观测矩阵的行向量 进行计算 其中 和 为辅助向量，计算公式如下 其中，Aij为探测器到第i个和第j个路标观测视线所形成的观测角。 对于n个导航路标，这样任意选取两个路标，两两组合后得到的观测矩阵行向量 共有 个值。观测矩阵H由所选取路标对应的行向量构成。 步骤3，利用步骤2得到的观测矩阵行向量，计算任意三个导航路标组合所对应的矩阵(HHT)-1的特征值之和利用步骤2得到的 个行向量 对n个导航路标中任意三个导航路标(如第i个、第j个和第k个)组合所对应的矩阵(HHT)-1的特征值之和∑λijk进行计算 其中θij，θjk，θki分别为观测矩阵行向量 之间形成的夹角。 若令则对于n个导航路标，这样任意选取三个路标组合后得到的∑λijk共有 个值。 步骤4，比较步骤3得到的特征值之和∑λijk，选取最优的三个导航路标比较步骤3得到的 个∑λijk值，以其中最小∑λijk值对应的第i个、第j个和第k个路标作为导航路标使用。 至此，完成深空探测器位置和姿态自主确定的导航路标的选取。 有益效果 本专利技术通过对观测矩阵的计算比较，考虑了导航路标及其与探测器之间位置关系对导航精度的影响，给出了一种导航路标选取方法。该方法相对已有的路标选取方法，不仅适用于三维空间中自主导航路标的选取，同时该方法由于利用解析表达式直接进行求解选取，因此具有解析可行、计算量小等优点，为近目标天体飞行的深空探测器提供了明确可行的导航路标选取方法。 附图说明 图1为本专利技术方法的流程图。 图2为本专利技术的具体实施方式中导航路标成像关系示意图。 具体实施例方式 为了更好地说明本专利技术的目的与优点，下面以利用路标进行自主导航的深空探测器为例，结合附图和具体实施方式对本专利技术做进一步说明。 深空探测器在目标天体附近，利用光学相机拍摄目标天体表面图像，提取其中如岩石、陨石坑等地形特征明显的路标点，将其作为深空探测器自主导航的参考点。利用三个路标点的信息就可以确定深空探测器相对目标天体的位置、姿态等状态，因此，为了简化实际工程算法、减少算法所占用的星载机计算时间，导航算法中采用三个导航路标来进行深空探测器的自主导航。由于在光学相机拍摄到的一幅图像中可以提取出许多个特征明显的路标点，那么如何在众多的路标点中选择三个路标作为最终的导航路标，以使导航精度达到最高，这便涉及到导航路标的最优选取问题了。 由于拍摄的导航路标像元、像线坐标中包含观测噪声，以及导航路标位置确定误差的存在，因此利用导航路标像素信息进行探测器位置、姿态确定必然存在误差。下面将通过对观测矩阵的分析，讨论导航路标的分布对位置确定精度、姿态确定精度的影响，进而给出导航路标选取的最优观测方法。 注意到对于最小二乘问题，有如下关系存在 X-X*＝本文档来自技高网...

【技术保护点】
基于观测矩阵的深空探测器导航路标选取方法，其特征在于包含如下步骤：步骤１，读取导航路标在目标天体坐标系下的位置数据，计算目标天体坐标系下ｎ个路标相对探测器的位置矢量；步骤２，为得到观测矩阵Ｈ，利用步骤１得到的目标天体坐标系下ｎ个路标相对探测器的位置矢量，计算观测矩阵的行向量；令ｎ↓［ｉ］＝＊↓［ｉ］／ｒ↓［ｉ］和＊↓［ｊ］＝＊↓［ｊ］／ｒ↓［ｊ］分别为第ｉ个与第ｊ个路标的单位视线向量，ｒ↓［ｉ］和ｒ↓［ｊ］为第ｉ个与第ｊ个路标到探测器的距离，对ｎ个导航路标中第ｉ个和第ｊ个路标组合的观测矩阵的行向量＊↓［ｉｊ］进行计算：＊↓［ｉｊ］＝＊↓［ｉｊ］／ｒ↓［ｉ］＋＊↓［ｊｉ］／ｒ↓［ｊ］（ｉ，ｊ＝１，２．．．ｎ）其中＊↓［ｉｊ］和＊↓［ｊｉ］为辅助向量，计算公式如下＊＊＊其中，Ａ↓［ｉｊ］为探测器到第ｉ个和第ｊ个路标观测视线所形成的观测角；对于ｎ个导航路标，任意选取两个路标，两两组合后得到的观测矩阵行向量共有１／２ｎ（ｎ－１）个值；步骤３，利用步骤２得到的观测矩阵行向量，计算任意三个导航路标组合所对应的矩阵（ＨＨ↑［Ｔ］）↑［－１］的特征值之和；利用步骤２得到的１／２ｎ（ｎ－１）个行向量，对ｎ个导航路标中任意三个导航路标如第ｉ个、第ｊ个和第ｋ个组合所对应的矩阵（ＨＨ↑［Ｔ］）↑［－１］的特征值之和∑λ↓［ｉｊｋ］进行计算Σλ↓［ｉｊｋ］＝（ｓｉｎ↑［２］θ↓［ｉｊ］／ｈ↓［ｉｊ］↑［２］＋ｓｉｎ↑［２］θ↓［ｊｋ］／ｈ↓［ｊｋ］↑［２］＋ｓｉｎ↑［２］θ↓［ｋｉ］／ｈ↓［ｋｉ］↑［２］）／（１－ｃｏｓ↑［２］θ↓［ｉｊ］－ｃｏｓ↑［２］θ↓［ｊｋ］－ｃｏｓ↑［２］θ↓［ｋｉ］＋２ｃｏｓθ↓［ｉｊ］ｃｏｓθ↓［ｊｋ］ｃｏｓθ↓［ｋｉ］）（ｉ，ｊ，ｋ＝１，２．．．ｎ）其中θ↓［ｉｊ］，θ↓［ｊｋ］，θ↓［ｋｉ］分别为观测矩阵行向量＊↓［ｉｊ］，＊↓［ｊｋ］，＊↓［ｋｉ］之间形成的夹角；若令ｍ＝１／２ｎ（ｎ－１），则对于ｎ个导航路标，这样任意选取三个路标组合后得到的∑λ↓［ｉｊｋ］共有１／６ｍ（ｍ－１）（ｍ－１）个值；步骤４，比较步骤３得到的特征值之和，选取最优的三个导航路标；比较步骤３得到的１／６ｍ（ｍ－１）（ｍ－２）个∑λ↓［ｉｊｋ］值，以其中最小∑λ↓［ｉｊｋ］值对应的任意三个路标作为导航路标使用。...

【技术特征摘要】

【专利技术属性】
技术研发人员：崔平远，朱圣英，徐瑞，乔栋，尚海滨，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：11[中国|北京]